7793703f64e0a63c9f2dca5a5045d224d4edd7f2
[allwinner_tvout_manipulator.git] / src / devmem2.c
1 /*
2  * devmem2.c: Simple program to read/write from/to any location in memory.
3  *
4  *  Copyright (C) 2000, Jan-Derk Bakker (J.D.Bakker@its.tudelft.nl)
5  *
6  *
7  */
8
9 #include <stdio.h>
10 #include <stdlib.h>
11 #include <unistd.h>
12 #include <string.h>
13 #include <errno.h>
14 #include <signal.h>
15 #include <fcntl.h>
16 #include <ctype.h>
17 #include <termios.h>
18 #include <sys/types.h>
19 #include <sys/mman.h>
20
21 #define FATAL do { fprintf(stderr, "Error at line %d, file %s (%d) [%s]\n", \
22   __LINE__, __FILE__, errno, strerror(errno)); exit(1); } while(0)
23
24 #define MAP_SIZE 4096UL
25 #define MAP_MASK (MAP_SIZE - 1)
26
27 void writemem(address, value, int accesstype) {
28     int fd;
29     void *map_base, *virt_addr;
30         unsigned long read_result, writeval;
31         off_t target;
32         int access_type = 'w';
33
34         if(argc < 2) {
35                 fprintf(stderr, "\nUsage:\t%s { address } [ type [ data ] ]\n"
36                         "\taddress : memory address to act upon\n"
37                         "\ttype    : access operation type : [b]yte, [h]alfword, [w]ord\n"
38                         "\tdata    : data to be written\n\n",
39                         argv[0]);
40                 exit(1);
41         }
42         target = strtoul(argv[1], 0, 0);
43
44         if(argc > 2)
45                 access_type = tolower(argv[2][0]);
46
47
48     if((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1) FATAL;
49     printf("/dev/mem opened.\n");
50     fflush(stdout);
51
52     /* Map one page */
53     map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, target & ~MAP_MASK);
54     if(map_base == (void *) -1) FATAL;
55     printf("Memory mapped at address %p.\n", map_base);
56     fflush(stdout);
57
58     virt_addr = map_base + (target & MAP_MASK);
59     switch(access_type) {
60                 case 'b':
61                         read_result = *((unsigned char *) virt_addr);
62                         break;
63                 case 'h':
64                         read_result = *((unsigned short *) virt_addr);
65                         break;
66                 case 'w':
67                         read_result = *((unsigned long *) virt_addr);
68                         break;
69                 default:
70                         fprintf(stderr, "Illegal data type '%c'.\n", access_type);
71                         exit(2);
72         }
73
74         if(argc > 3) {
75                 writeval = strtoul(argv[3], 0, 0);
76                 switch(access_type) {
77                         case 'b':
78                                 *((unsigned char *) virt_addr) = writeval;
79                                 read_result = *((unsigned char *) virt_addr);
80                                 break;
81                         case 'h':
82                                 *((unsigned short *) virt_addr) = writeval;
83                                 read_result = *((unsigned short *) virt_addr);
84                                 break;
85                         case 'w':
86                                 *((unsigned long *) virt_addr) = writeval;
87                                 read_result = *((unsigned long *) virt_addr);
88                                 break;
89                 }
90                 printf("Written 0x%X; readback 0x%X\n", writeval, read_result);
91                 fflush(stdout);
92         }
93
94         if(munmap(map_base, MAP_SIZE) == -1) FATAL;
95     close(fd);
96     return 0;
97 }
98
99 void readmem(address, int accesstype)
100 {
101     int fd;
102     void *map_base, *virt_addr;
103         unsigned long read_result, writeval;
104         off_t target;
105         int access_type = accesstype;
106
107         target = strtoul(argv[1], 0, 0);
108
109
110     if((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1) FATAL;
111     printf("/dev/mem opened.\n");
112     fflush(stdout);
113
114     /* Map one page */
115     map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, target & ~MAP_MASK);
116     if(map_base == (void *) -1) FATAL;
117     printf("Memory mapped at address %p.\n", map_base);
118     fflush(stdout);
119
120     virt_addr = map_base + (target & MAP_MASK);
121     switch(access_type) {
122                 case 'b':
123                         read_result = *((unsigned char *) virt_addr);
124                         break;
125                 case 'h':
126                         read_result = *((unsigned short *) virt_addr);
127                         break;
128                 case 'w':
129                         read_result = *((unsigned long *) virt_addr);
130                         break;
131                 default:
132                         fprintf(stderr, "Illegal data type '%c'.\n", access_type);
133                         exit(2);
134         }
135 }
136