FreeCalypso > hg > freecalypso-tools
diff 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 |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/target-utils/pln-ppb-test/mode_entry.c Sat Dec 02 23:50:07 2023 +0000 @@ -0,0 +1,32 @@ +/* + * mode-entry and mode-exit commands + */ + +#include <sys/types.h> +#include "types.h" + +void +cmd_mode_entry(argbulk) + char *argbulk; +{ + char *argv[3]; + u_long addr, mode; + + if (parse_args(argbulk, 2, 2, argv, 0) < 0) + return; + if (parse_hexarg(argv[0], 8, &addr) < 0) { + printf("ERROR: arg1 must be a valid 32-bit hex address\n"); + return; + } + if (addr & 0xFFFF) { + printf("ERROR: address is not on 64 KiB boundary\n"); + return; + } + if (parse_hexarg(argv[1], 4, &mode) < 0) { + printf("ERROR: arg2 must be a valid 16-bit hex value\n"); + return; + } + *(volatile u16 *)(addr + 0xAAA) = 0xAA; + *(volatile u16 *)(addr + 0x554) = 0x55; + *(volatile u16 *)(addr + 0xAAA) = mode; +}