Casting unsigned long to unsigned int to avoid compiler warnings
[allwinner_tvout_manipulator.git] / src / devmem2.c
1 ///////////////////////////////////////////////////////////////////////////
2 // Workfile: devmem2.c (Implementation)
3 // Author: Jan-Derk Bakker, Daniel Giritzer
4 // Date: 2017-06-02
5 // Description: Simple module to read/write from/to any location in memory.
6 // Remarks: -
7 // Revision: 1
8 // Copyright (C) 2000, Jan-Derk Bakker (J.D.Bakker@its.tudelft.nl)
9 // Copyright (C) 2017, Daniel Giritzer (giri@nwrk.biz)
10 ///////////////////////////////////////////////////////////////////////////
11 #include <stdio.h>
12 #include <stdlib.h>
13 #include <unistd.h>
14 #include <string.h>
15 #include <string.h>
16 #include <errno.h>
17 #include <signal.h>
18 #include <fcntl.h>
19 #include <ctype.h>
20 #include <termios.h>
21 #include <sys/types.h>
22 #include <sys/mman.h>
23
24 #define MAP_SIZE 4096UL
25 #define MAP_MASK (MAP_SIZE - 1)
26
27 static void ERROR(char* custom)
28 {
29     fprintf(stderr, "Error: %s \n", custom);
30     fprintf(stderr, "Error Nr: %d, %s\n",
31             errno, strerror(errno));
32 }
33
34 int writemem(char* address, char* value, int access_type)
35 {
36     int fd;
37     void *map_base = 0;
38     void *virt_addr = 0;
39     unsigned long writeval = 0;
40
41     off_t target = strtoul(address, 0, 0);
42
43
44     if((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1)
45     {
46         ERROR("Opening /dev/mem/ failed!");
47         return EXIT_FAILURE;
48     };
49
50     // Map one page
51     map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, target & ~MAP_MASK);
52
53     if(map_base == (void *) -1)
54     {
55         ERROR("Mapping Memory Page Failed!");
56         return EXIT_FAILURE;
57     }
58
59
60     writeval = strtoul(value, 0, 0);
61     switch(access_type)
62     {
63     case 'b':
64         *((unsigned char *) virt_addr) = writeval;
65         break;
66     case 'h':
67         *((unsigned short *) virt_addr) = writeval;
68         break;
69     case 'w':
70         *((unsigned long *) virt_addr) = writeval;
71         break;
72     default:
73         ERROR("Wrong access_type set!");
74         break;
75     }
76
77
78     if(munmap(map_base, MAP_SIZE) == -1)
79     {
80         ERROR("Unmapping Memory Page Failed!");
81         return EXIT_FAILURE;
82     }
83
84     close(fd);
85     return EXIT_SUCCESS;
86 }
87
88 int readmem(char* address, int access_type, unsigned long *result)
89 {
90     int fd;
91     void *map_base, *virt_addr;
92     off_t target;
93     unsigned long read_result = 0;
94
95     target = strtoul(address, 0, 0);
96
97     if(result == NULL)
98     {
99         //Print error on failure
100         ERROR("Result Parameter is a nullpointer!");
101         return EXIT_FAILURE;
102     }
103
104
105     // Try to open /dev/mem
106     if((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1)
107     {
108         //Print error on failure
109         ERROR("Opening /dev/mem/ failed!");
110         return EXIT_FAILURE;
111     };
112
113     // Map one page
114     map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, target & ~MAP_MASK);
115
116     // Check if mapping was successful
117     if(map_base == (void *) -1)
118     {
119         ERROR("Mapping Memory Page Failed!");
120         return EXIT_FAILURE;
121     }
122
123     virt_addr = map_base + (target & MAP_MASK);
124     switch(access_type)
125     {
126     case 'b':
127         read_result = *((unsigned char *) virt_addr);
128         break;
129     case 'h':
130         read_result = *((unsigned short *) virt_addr);
131         break;
132     case 'w':
133         read_result = *((unsigned long *) virt_addr);
134         break;
135     default:
136         ERROR("Wrong access_type set!");
137         break;
138     }
139
140     if(munmap(map_base, MAP_SIZE) == -1)
141     {
142         ERROR("Unmapping Memory Page Failed!");
143         return EXIT_FAILURE;
144     }
145
146     *result = read_result;
147
148     close(fd);
149     return EXIT_SUCCESS;
150 }
151