FreeCalypso > hg > freecalypso-tools
annotate target-utils/pln-ppb-test/mode_entry.c @ 1009:4a153059abbb
doc/DUART28-boot-control: update for fc-linux-patch and fc-usbser-tools
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Tue, 12 Dec 2023 06:57:11 +0000 |
parents | 6b87de9e385b |
children |
rev | line source |
---|---|
986
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /* |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 * mode-entry and mode-exit commands |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 */ |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
5 #include <sys/types.h> |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
6 #include "types.h" |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 void |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 cmd_mode_entry(argbulk) |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 char *argbulk; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 { |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 char *argv[3]; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
13 u_long addr, mode; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 if (parse_args(argbulk, 2, 2, argv, 0) < 0) |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 return; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 if (parse_hexarg(argv[0], 8, &addr) < 0) { |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 printf("ERROR: arg1 must be a valid 32-bit hex address\n"); |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
19 return; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20 } |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 if (addr & 0xFFFF) { |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22 printf("ERROR: address is not on 64 KiB boundary\n"); |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 return; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 } |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25 if (parse_hexarg(argv[1], 4, &mode) < 0) { |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26 printf("ERROR: arg2 must be a valid 16-bit hex value\n"); |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27 return; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28 } |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29 *(volatile u16 *)(addr + 0xAAA) = 0xAA; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 *(volatile u16 *)(addr + 0x554) = 0x55; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 *(volatile u16 *)(addr + 0xAAA) = mode; |
676203b4bf33
pln-ppb-test: implement mode-entry
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 } |
987
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
33 |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
34 void |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
35 cmd_mode_exit(argbulk) |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
36 char *argbulk; |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
37 { |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
38 char *argv[2]; |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
39 u_long addr; |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
40 |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
41 if (parse_args(argbulk, 1, 1, argv, 0) < 0) |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
42 return; |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
43 if (parse_hexarg(argv[0], 8, &addr) < 0) { |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
44 printf("ERROR: argument must be a valid 32-bit hex address\n"); |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
45 return; |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
46 } |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
47 if (addr & 0xFFFF) { |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
48 printf("ERROR: address is not on 64 KiB boundary\n"); |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
49 return; |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
50 } |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
51 *(volatile u16 *)addr = 0x90; |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
52 *(volatile u16 *)addr = 0x00; |
6b87de9e385b
pln-ppb-test: implement mode-exit
Mychaela Falconia <falcon@freecalypso.org>
parents:
986
diff
changeset
|
53 } |