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 }