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