rwhandler.c

   1 #include "rwhandler.h"
   2 #include "ioport.h"
   3 #include "cpu-all.h"
   4
   5 #if !defined(CONFIG_USER_ONLY)
   6
   7 #define RWHANDLER_WRITE(name, len, type) \
   8 static void name(void *opaque, type addr, uint32_t value) \
   9 {\
  10     struct ReadWriteHandler *handler = opaque;\
  11     handler->write(handler, addr, value, len);\
  12 }
  13
  14 #define RWHANDLER_READ(name, len, type) \
  15 static uint32_t name(void *opaque, type addr) \
  16 { \
  17     struct ReadWriteHandler *handler = opaque; \
  18     return handler->read(handler, addr, len); \
  19 }
  20
  21 RWHANDLER_WRITE(cpu_io_memory_simple_writeb, 1, target_phys_addr_t);
  22 RWHANDLER_READ(cpu_io_memory_simple_readb, 1, target_phys_addr_t);
  23 RWHANDLER_WRITE(cpu_io_memory_simple_writew, 2, target_phys_addr_t);
  24 RWHANDLER_READ(cpu_io_memory_simple_readw, 2, target_phys_addr_t);
  25 RWHANDLER_WRITE(cpu_io_memory_simple_writel, 4, target_phys_addr_t);
  26 RWHANDLER_READ(cpu_io_memory_simple_readl, 4, target_phys_addr_t);
  27
  28 static CPUWriteMemoryFunc * const cpu_io_memory_simple_write[] = {
  29     &cpu_io_memory_simple_writeb,
  30     &cpu_io_memory_simple_writew,
  31     &cpu_io_memory_simple_writel,
  32 };
  33
  34 static CPUReadMemoryFunc * const cpu_io_memory_simple_read[] = {
  35     &cpu_io_memory_simple_readb,
  36     &cpu_io_memory_simple_readw,
  37     &cpu_io_memory_simple_readl,
  38 };
  39
  40 int cpu_register_io_memory_simple(struct ReadWriteHandler *handler)
  41 {
  42     if (!handler->read || !handler->write) {
  43         return -1;
  44     }
  45     return cpu_register_io_memory(cpu_io_memory_simple_read,
  46                                   cpu_io_memory_simple_write,
  47                                   handler);
  48 }
  49
  50 RWHANDLER_WRITE(ioport_simple_writeb, 1, uint32_t);
  51 RWHANDLER_READ(ioport_simple_readb, 1, uint32_t);
  52 RWHANDLER_WRITE(ioport_simple_writew, 2, uint32_t);
  53 RWHANDLER_READ(ioport_simple_readw, 2, uint32_t);
  54 RWHANDLER_WRITE(ioport_simple_writel, 4, uint32_t);
  55 RWHANDLER_READ(ioport_simple_readl, 4, uint32_t);
  56
  57 int register_ioport_simple(ReadWriteHandler* handler,
  58                            pio_addr_t start, int length, int size)
  59 {
  60     IOPortWriteFunc *write;
  61     IOPortReadFunc *read;
  62     int r;
  63     switch (size) {
  64     case 1:
  65         write = ioport_simple_writeb;
  66         read = ioport_simple_readb;
  67         break;
  68     case 2:
  69         write = ioport_simple_writew;
  70         read = ioport_simple_readw;
  71         break;
  72     default:
  73         write = ioport_simple_writel;
  74         read = ioport_simple_readl;
  75     }
  76     if (handler->write) {
  77         r = register_ioport_write(start, length, size, write, handler);
  78         if (r < 0) {
  79             return r;
  80         }
  81     }
  82     if (handler->read) {
  83         r = register_ioport_read(start, length, size, read, handler);
  84         if (r < 0) {
  85             return r;
  86         }
  87     }
  88     return 0;
  89 }
  90
  91 #endif