FreeCalypso > hg > freecalypso-tools
comparison target-utils/pln-ppb-test/mode_entry.c @ 986:676203b4bf33
pln-ppb-test: implement mode-entry
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sat, 02 Dec 2023 23:50:07 +0000 |
parents | |
children | 6b87de9e385b |
comparison
equal
deleted
inserted
replaced
985:d50df222c274 | 986:676203b4bf33 |
---|---|
1 /* | |
2 * mode-entry and mode-exit commands | |
3 */ | |
4 | |
5 #include <sys/types.h> | |
6 #include "types.h" | |
7 | |
8 void | |
9 cmd_mode_entry(argbulk) | |
10 char *argbulk; | |
11 { | |
12 char *argv[3]; | |
13 u_long addr, mode; | |
14 | |
15 if (parse_args(argbulk, 2, 2, argv, 0) < 0) | |
16 return; | |
17 if (parse_hexarg(argv[0], 8, &addr) < 0) { | |
18 printf("ERROR: arg1 must be a valid 32-bit hex address\n"); | |
19 return; | |
20 } | |
21 if (addr & 0xFFFF) { | |
22 printf("ERROR: address is not on 64 KiB boundary\n"); | |
23 return; | |
24 } | |
25 if (parse_hexarg(argv[1], 4, &mode) < 0) { | |
26 printf("ERROR: arg2 must be a valid 16-bit hex value\n"); | |
27 return; | |
28 } | |
29 *(volatile u16 *)(addr + 0xAAA) = 0xAA; | |
30 *(volatile u16 *)(addr + 0x554) = 0x55; | |
31 *(volatile u16 *)(addr + 0xAAA) = mode; | |
32 } |