|
30 | 30 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
31 | 31 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
32 | 32 | * GNU General Public License for more details. |
33 | | - * |
| 33 | + * |
34 | 34 | * You should have received a copy of the GNU General Public License |
35 | 35 | * along with this program; if not, write to the Free Software |
36 | 36 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
|
48 | 48 | #include <termios.h> |
49 | 49 | #include <sys/types.h> |
50 | 50 | #include <sys/mman.h> |
51 | | - |
| 51 | + |
52 | 52 | #define FATAL do { fprintf(stderr, "Error at line %d, file %s (%d) [%s]\n", \ |
53 | | - __LINE__, __FILE__, errno, strerror(errno)); exit(1); } while(0) |
54 | | - |
| 53 | + __LINE__, __FILE__, errno, strerror(errno)); exit(1); } while(0) |
| 54 | + |
55 | 55 | #define MAP_SIZE 4096UL |
56 | 56 | #define MAP_MASK (MAP_SIZE - 1) |
57 | 57 |
|
58 | | -int main(int argc, char **argv) { |
| 58 | +int main(int argc, char** argv) { |
59 | 59 | int fd; |
60 | | - void *map_base, *virt_addr; |
61 | | - unsigned long read_result, writeval; |
62 | | - off_t target; |
63 | | - int access_type = 'w'; |
64 | | - |
65 | | - if(argc < 2) { |
66 | | - fprintf(stderr, "\nUsage:\t%s { address } [ type [ data ] ]\n" |
67 | | - "\taddress : memory address to act upon\n" |
68 | | - "\ttype : access operation type : [b]yte, [h]alfword, [w]ord\n" |
69 | | - "\tdata : data to be written\n\n", |
70 | | - argv[0]); |
71 | | - exit(1); |
72 | | - } |
73 | | - target = strtoul(argv[1], 0, 0); |
74 | | - |
75 | | - if(argc > 2) |
76 | | - access_type = tolower(argv[2][0]); |
77 | | - |
78 | | - |
79 | | - if((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1) FATAL; |
80 | | - printf("/dev/mem opened.\n"); |
| 60 | + void* map_base, *virt_addr; |
| 61 | + unsigned long read_result, writeval; |
| 62 | + off_t target; |
| 63 | + int access_type = 'w'; |
| 64 | + |
| 65 | + if (argc < 2) { |
| 66 | + fprintf(stderr, "\nUsage:\t%s { address } [ type [ data ] ]\n" |
| 67 | + "\taddress : memory address to act upon\n" |
| 68 | + "\ttype : access operation type : [b]yte, [h]alfword, [w]ord\n" |
| 69 | + "\tdata : data to be written\n\n", |
| 70 | + argv[0]); |
| 71 | + exit(1); |
| 72 | + } |
| 73 | + |
| 74 | + target = strtoul(argv[1], 0, 0); |
| 75 | + |
| 76 | + if (argc > 2) { |
| 77 | + access_type = tolower(argv[2][0]); |
| 78 | + } |
| 79 | + |
| 80 | + |
| 81 | + if ((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1) { |
| 82 | + FATAL; |
| 83 | + } |
| 84 | + |
| 85 | + printf("/dev/mem opened.\n"); |
81 | 86 | fflush(stdout); |
82 | | - |
| 87 | + |
83 | 88 | /* Map one page */ |
84 | 89 | map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, target & ~MAP_MASK); |
85 | | - if(map_base == (void *) -1) FATAL; |
86 | | - printf("Memory mapped at address %p.\n", map_base); |
| 90 | + |
| 91 | + if (map_base == (void*) - 1) { |
| 92 | + FATAL; |
| 93 | + } |
| 94 | + |
| 95 | + printf("Memory mapped at address %p.\n", map_base); |
87 | 96 | fflush(stdout); |
88 | | - |
| 97 | + |
89 | 98 | virt_addr = map_base + (target & MAP_MASK); |
90 | | - switch(access_type) { |
91 | | - case 'b': |
92 | | - read_result = *((unsigned char *) virt_addr); |
93 | | - break; |
94 | | - case 'h': |
95 | | - read_result = *((unsigned short *) virt_addr); |
96 | | - break; |
97 | | - case 'w': |
98 | | - read_result = *((unsigned long *) virt_addr); |
99 | | - break; |
100 | | - default: |
101 | | - fprintf(stderr, "Illegal data type '%c'.\n", access_type); |
102 | | - exit(2); |
103 | | - } |
104 | | - printf("Value at address 0x%X (%p): 0x%X\n", target, virt_addr, read_result); |
| 99 | + |
| 100 | + switch (access_type) { |
| 101 | + case 'b': |
| 102 | + read_result = *((unsigned char*) virt_addr); |
| 103 | + break; |
| 104 | + |
| 105 | + case 'h': |
| 106 | + read_result = *((unsigned short*) virt_addr); |
| 107 | + break; |
| 108 | + |
| 109 | + case 'w': |
| 110 | + read_result = *((unsigned long*) virt_addr); |
| 111 | + break; |
| 112 | + |
| 113 | + default: |
| 114 | + fprintf(stderr, "Illegal data type '%c'.\n", access_type); |
| 115 | + exit(2); |
| 116 | + } |
| 117 | + |
| 118 | + printf("Value at address 0x%X (%p): 0x%X\n", target, virt_addr, read_result); |
105 | 119 | fflush(stdout); |
106 | 120 |
|
107 | | - if(argc > 3) { |
108 | | - writeval = strtoul(argv[3], 0, 0); |
109 | | - switch(access_type) { |
110 | | - case 'b': |
111 | | - *((unsigned char *) virt_addr) = writeval; |
112 | | - read_result = *((unsigned char *) virt_addr); |
113 | | - break; |
114 | | - case 'h': |
115 | | - *((unsigned short *) virt_addr) = writeval; |
116 | | - read_result = *((unsigned short *) virt_addr); |
117 | | - break; |
118 | | - case 'w': |
119 | | - *((unsigned long *) virt_addr) = writeval; |
120 | | - read_result = *((unsigned long *) virt_addr); |
121 | | - break; |
122 | | - } |
123 | | - printf("Written 0x%X; readback 0x%X\n", writeval, read_result); |
124 | | - fflush(stdout); |
125 | | - } |
126 | | - |
127 | | - if(munmap(map_base, MAP_SIZE) == -1) FATAL; |
| 121 | + if (argc > 3) { |
| 122 | + writeval = strtoul(argv[3], 0, 0); |
| 123 | + |
| 124 | + switch (access_type) { |
| 125 | + case 'b': |
| 126 | + *((unsigned char*) virt_addr) = writeval; |
| 127 | + read_result = *((unsigned char*) virt_addr); |
| 128 | + break; |
| 129 | + |
| 130 | + case 'h': |
| 131 | + *((unsigned short*) virt_addr) = writeval; |
| 132 | + read_result = *((unsigned short*) virt_addr); |
| 133 | + break; |
| 134 | + |
| 135 | + case 'w': |
| 136 | + *((unsigned long*) virt_addr) = writeval; |
| 137 | + read_result = *((unsigned long*) virt_addr); |
| 138 | + break; |
| 139 | + } |
| 140 | + |
| 141 | + printf("Written 0x%X; readback 0x%X\n", writeval, read_result); |
| 142 | + fflush(stdout); |
| 143 | + } |
| 144 | + |
| 145 | + if (munmap(map_base, MAP_SIZE) == -1) { |
| 146 | + FATAL; |
| 147 | + } |
| 148 | + |
128 | 149 | close(fd); |
129 | 150 | return 0; |
130 | 151 | } |
|
0 commit comments