The Android Open Source Project | dd7bc33 | 2009-03-03 19:32:55 -0800 | [diff] [blame] | 1 | #include <stdio.h> |
| 2 | #include <stdlib.h> |
| 3 | #include <string.h> |
| 4 | #include <unistd.h> |
| 5 | #include <fcntl.h> |
| 6 | #include <malloc.h> |
| 7 | |
| 8 | /* ioctl crap */ |
| 9 | #define SYREN_RD 101 |
| 10 | #define SYREN_WR 102 |
| 11 | #define SYREN_OLD_RD 108 |
| 12 | #define SYREN_OLD_WR 109 |
| 13 | |
| 14 | struct syren_io_args { |
| 15 | unsigned long page; |
| 16 | unsigned long addr; |
| 17 | unsigned long value; |
| 18 | }; |
| 19 | |
| 20 | typedef struct { |
| 21 | u_char page; |
| 22 | u_char addr; |
| 23 | const char *name; |
| 24 | } syren_reg; |
| 25 | |
| 26 | static syren_reg registers[] = { |
| 27 | { 0, 0x04, "TOGBR1" }, |
| 28 | { 0, 0x05, "TOGBR2" }, |
| 29 | { 0, 0x06, "VBDCTRL" }, |
| 30 | { 1, 0x07, "VBUCTRL" }, |
| 31 | { 1, 0x08, "VBCTRL" }, |
| 32 | { 1, 0x09, "PWDNRG" }, |
| 33 | { 1, 0x0a, "VBPOP" }, |
| 34 | { 1, 0x0b, "VBCTRL2" }, |
| 35 | { 1, 0x0f, "VAUDCTRL" }, |
| 36 | { 1, 0x10, "VAUSCTRL" }, |
| 37 | { 1, 0x11, "VAUOCTRL" }, |
| 38 | { 1, 0x12, "VAUDPLL" }, |
| 39 | { 1, 0x17, "VRPCSIMR" }, |
| 40 | { 0, 0, 0 } |
| 41 | }; |
| 42 | |
| 43 | static syren_reg *find_reg(const char *name) |
| 44 | { |
| 45 | int i; |
| 46 | |
| 47 | for (i = 0; registers[i].name != 0; i++) { |
| 48 | if (!strcasecmp(registers[i].name, name)) |
| 49 | return ®isters[i]; |
| 50 | } |
| 51 | |
| 52 | return NULL; |
| 53 | } |
| 54 | |
| 55 | static int usage(void) |
| 56 | { |
| 57 | fprintf(stderr, "usage: syren [r/w] [REGNAME | page:addr] (value)\n"); |
| 58 | return 1; |
| 59 | } |
| 60 | |
| 61 | int |
| 62 | syren_main(int argc, char **argv) |
| 63 | { |
| 64 | int cmd = -1; |
| 65 | syren_reg *r; |
| 66 | struct syren_io_args sio; |
| 67 | char name[32]; |
| 68 | int fd; |
| 69 | |
| 70 | if (argc < 3) { |
| 71 | return usage(); |
| 72 | } |
| 73 | |
| 74 | switch(argv[1][0]) { |
| 75 | case 'r': |
| 76 | cmd = SYREN_RD; |
| 77 | break; |
| 78 | case 'w': |
| 79 | cmd = SYREN_WR; |
| 80 | break; |
| 81 | case 'R': |
| 82 | cmd = SYREN_OLD_RD; |
| 83 | break; |
| 84 | case 'W': |
| 85 | cmd = SYREN_OLD_WR; |
| 86 | break; |
| 87 | default: |
| 88 | return usage(); |
| 89 | } |
| 90 | |
| 91 | if (cmd == SYREN_WR || cmd == SYREN_OLD_WR) { |
| 92 | if (argc < 4) |
| 93 | return usage(); |
| 94 | sio.value = strtoul(argv[3], 0, 0); |
| 95 | } |
| 96 | |
| 97 | fd = open("/dev/eac", O_RDONLY); |
| 98 | if (fd < 0) { |
| 99 | fprintf(stderr, "can't open /dev/eac\n"); |
| 100 | return 1; |
| 101 | } |
| 102 | |
| 103 | if (strcasecmp(argv[2], "all") == 0) { |
| 104 | int i; |
| 105 | if (cmd != SYREN_RD && cmd != SYREN_OLD_RD) { |
| 106 | fprintf(stderr, "can only read all registers\n"); |
| 107 | return 1; |
| 108 | } |
| 109 | |
| 110 | for (i = 0; registers[i].name; i++) { |
| 111 | sio.page = registers[i].page; |
| 112 | sio.addr = registers[i].addr; |
| 113 | if (ioctl(fd, cmd, &sio) < 0) { |
| 114 | fprintf(stderr, "%s: error\n", registers[i].name); |
| 115 | } else { |
| 116 | fprintf(stderr, "%s: %04x\n", registers[i].name, sio.value); |
| 117 | } |
| 118 | } |
| 119 | |
| 120 | close(fd); |
| 121 | return 0; |
| 122 | } |
| 123 | |
| 124 | r = find_reg(argv[2]); |
| 125 | if (r == NULL) { |
nks | 3967f81 | 2014-04-12 18:52:27 +0200 | [diff] [blame] | 126 | if(strlen(argv[2]) >= sizeof(name)){ |
| 127 | fprintf(stderr, "REGNAME too long\n"); |
| 128 | return 0; |
| 129 | } |
| 130 | strlcpy(name, argv[2], sizeof(name)); |
The Android Open Source Project | dd7bc33 | 2009-03-03 19:32:55 -0800 | [diff] [blame] | 131 | char *addr_str = strchr(argv[2], ':'); |
| 132 | if (addr_str == NULL) |
| 133 | return usage(); |
| 134 | *addr_str++ = 0; |
| 135 | sio.page = strtoul(argv[2], 0, 0); |
| 136 | sio.addr = strtoul(addr_str, 0, 0); |
| 137 | } else { |
nks | 3967f81 | 2014-04-12 18:52:27 +0200 | [diff] [blame] | 138 | strlcpy(name, r->name, sizeof(name)); |
The Android Open Source Project | dd7bc33 | 2009-03-03 19:32:55 -0800 | [diff] [blame] | 139 | sio.page = r->page; |
| 140 | sio.addr = r->addr; |
| 141 | } |
| 142 | |
| 143 | if (ioctl(fd, cmd, &sio) < 0) { |
| 144 | fprintf(stderr, "ioctl(%d) failed\n", cmd); |
| 145 | return 1; |
| 146 | } |
| 147 | |
| 148 | if (cmd == SYREN_RD || cmd == SYREN_OLD_RD) { |
| 149 | printf("%s: %04x\n", name, sio.value); |
| 150 | } else { |
| 151 | printf("wrote %04x to %s\n", sio.value, name); |
| 152 | } |
| 153 | |
| 154 | close(fd); |
| 155 | |
| 156 | return 0; |
| 157 | } |
| 158 | |