1.1 Release
[allwinner_tvout_manipulator.git] / src / devmem2.c
index cd33ceb..720aab5 100644 (file)
@@ -12,7 +12,6 @@
 #include <stdlib.h>
 #include <unistd.h>
 #include <string.h>
-#include <string.h>
 #include <errno.h>
 #include <signal.h>
 #include <fcntl.h>
@@ -47,21 +46,20 @@ static void ERROR(char* custom)
 /// \brief This function allows writing to memory
 ///        on the specified address.
 ///
-/// \param char* Address to write to
-/// \param char* Value to write
+/// \param unsigned long Address to write to
+/// \param unsigned long Value to write
 /// \param int Access type, should be 'w' (word),
 ///        'h' (halfword), 'b'(byte)
 /////////////////////////////////////////////////
-int writemem(char* address, char* value, int access_type)
+int writemem(unsigned long address, unsigned long writeval, int access_type)
 {
     int fd;
     void *map_base = 0;
     void *virt_addr = 0;
-    unsigned long writeval = 0;
-
-    off_t target = strtoul(address, 0, 0);
 
+    off_t target = address;
 
+    // Try to open /dev/mem
     if((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1)
     {
         ERROR("Opening /dev/mem/ failed!");
@@ -71,14 +69,18 @@ int writemem(char* address, char* value, int access_type)
     // Map one page
     map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, target & ~MAP_MASK);
 
+    // Check if mapping was successful
     if(map_base == (void *) -1)
     {
+        //Print error on failure
         ERROR("Mapping Memory Page Failed!");
         return EXIT_FAILURE;
     }
 
+    //calculate virtual address
+    virt_addr = map_base + (target & MAP_MASK);
 
-    writeval = strtoul(value, 0, 0);
+    //write value to memory
     switch(access_type)
     {
     case 'b':
@@ -95,7 +97,7 @@ int writemem(char* address, char* value, int access_type)
         break;
     }
 
-
+    //unmap memory
     if(munmap(map_base, MAP_SIZE) == -1)
     {
         ERROR("Unmapping Memory Page Failed!");
@@ -110,20 +112,20 @@ int writemem(char* address, char* value, int access_type)
 /// \brief This function allows reading the memory
 ///        on the specified address.
 ///
-/// \param char* Address to read from
+/// \param unsigned long Address to read from
 /// \param int Access type, should be 'w' (word),
 ///        'h' (halfword), 'b'(byte)
 /// \param unsigned long* pointer result variable
 /////////////////////////////////////////////////
-int readmem(char* address, int access_type, unsigned long *result)
+int readmem(unsigned long address, int access_type, unsigned long *result)
 {
     int fd;
     void *map_base, *virt_addr;
-    off_t target;
     unsigned long read_result = 0;
 
-    target = strtoul(address, 0, 0);
+    off_t target = address;
 
+    //check if result variable is a nullpointer
     if(result == NULL)
     {
         //Print error on failure
@@ -150,7 +152,10 @@ int readmem(char* address, int access_type, unsigned long *result)
         return EXIT_FAILURE;
     }
 
+    //calculate virtual address
     virt_addr = map_base + (target & MAP_MASK);
+
+    //read value
     switch(access_type)
     {
     case 'b':
@@ -167,12 +172,14 @@ int readmem(char* address, int access_type, unsigned long *result)
         break;
     }
 
+    // unmap memory
     if(munmap(map_base, MAP_SIZE) == -1)
     {
         ERROR("Unmapping Memory Page Failed!");
         return EXIT_FAILURE;
     }
 
+    // return result
     *result = read_result;
 
     close(fd);