annotate target-utils/pln-ppb-test/read_id.c @ 988:5a6019ed7e72

pln-ppb-test: implement read-id
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 03 Dec 2023 00:04:18 +0000
parents
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
988
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
1 /*
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
2 * read-id (Autoselect) command
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
3 */
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
4
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
5 #include <sys/types.h>
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
6 #include "types.h"
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
7
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
8 void
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
9 cmd_read_id(argbulk)
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
10 char *argbulk;
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
11 {
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
12 char *argv[2];
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
13 u_long addr;
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
14
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
15 if (parse_args(argbulk, 1, 1, argv, 0) < 0)
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
16 return;
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
17 if (parse_hexarg(argv[0], 8, &addr) < 0) {
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
18 printf("ERROR: argument must be a valid 32-bit hex address\n");
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
19 return;
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
20 }
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
21 if (addr & 0xFFFF) {
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
22 printf("ERROR: address is not on 64 KiB boundary\n");
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
23 return;
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
24 }
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
25 *(volatile u16 *)(addr + 0xAAA) = 0xAA;
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
26 *(volatile u16 *)(addr + 0x554) = 0x55;
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
27 *(volatile u16 *)(addr + 0xAAA) = 0x90;
5a6019ed7e72 pln-ppb-test: implement read-id
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
28 }