hw/testdev.c

   1 #include <sys/mman.h>
   2 #include "hw.h"
   3 #include "qdev.h"
   4 #include "isa.h"
   5
   6 struct testdev {
   7     ISADevice dev;
   8     CharDriverState *chr;
   9 };
  10
  11 static void test_device_serial_write(void *opaque, uint32_t addr, uint32_t data)
  12 {
  13     struct testdev *dev = opaque;
  14     uint8_t buf[1] = { data };
  15
  16     if (dev->chr) {
  17         qemu_chr_write(dev->chr, buf, 1);
  18     }
  19 }
  20
  21 static void test_device_exit(void *opaque, uint32_t addr, uint32_t data)
  22 {
  23     exit(data);
  24 }
  25
  26 static uint32_t test_device_memsize_read(void *opaque, uint32_t addr)
  27 {
  28     return ram_size;
  29 }
  30
  31 static void test_device_irq_line(void *opaque, uint32_t addr, uint32_t data)
  32 {
  33     qemu_set_irq(isa_get_irq(addr - 0x2000), !!data);
  34 }
  35
  36 static uint32 test_device_ioport_data;
  37
  38 static void test_device_ioport_write(void *opaque, uint32_t addr, uint32_t data)
  39 {
  40     test_device_ioport_data = data;
  41 }
  42
  43 static uint32_t test_device_ioport_read(void *opaque, uint32_t addr)
  44 {
  45     return test_device_ioport_data;
  46 }
  47
  48 static void test_device_flush_page(void *opaque, uint32_t addr, uint32_t data)
  49 {
  50     target_phys_addr_t len = 4096;
  51     void *a = cpu_physical_memory_map(data & ~0xffful, &len, 0);
  52
  53     mprotect(a, 4096, PROT_NONE);
  54     mprotect(a, 4096, PROT_READ|PROT_WRITE);
  55     cpu_physical_memory_unmap(a, len, 0, 0);
  56 }
  57
  58 static char *iomem_buf;
  59
  60 static uint32_t test_iomem_readb(void *opaque, target_phys_addr_t addr)
  61 {
  62     return iomem_buf[addr];
  63 }
  64
  65 static uint32_t test_iomem_readw(void *opaque, target_phys_addr_t addr)
  66 {
  67     return *(uint16_t*)(iomem_buf + addr);
  68 }
  69
  70 static uint32_t test_iomem_readl(void *opaque, target_phys_addr_t addr)
  71 {
  72     return *(uint32_t*)(iomem_buf + addr);
  73 }
  74
  75 static void test_iomem_writeb(void *opaque, target_phys_addr_t addr, uint32_t val)
  76 {
  77     iomem_buf[addr] = val;
  78 }
  79
  80 static void test_iomem_writew(void *opaque, target_phys_addr_t addr, uint32_t val)
  81 {
  82     *(uint16_t*)(iomem_buf + addr) = val;
  83 }
  84
  85 static void test_iomem_writel(void *opaque, target_phys_addr_t addr, uint32_t val)
  86 {
  87     *(uint32_t*)(iomem_buf + addr) = val;
  88 }
  89
  90 static CPUReadMemoryFunc * const test_iomem_read[3] = {
  91     test_iomem_readb,
  92     test_iomem_readw,
  93     test_iomem_readl,
  94 };
  95
  96 static CPUWriteMemoryFunc * const test_iomem_write[3] = {
  97     test_iomem_writeb,
  98     test_iomem_writew,
  99     test_iomem_writel,
 100 };
 101
 102 static int init_test_device(ISADevice *isa)
 103 {
 104     struct testdev *dev = DO_UPCAST(struct testdev, dev, isa);
 105     int iomem;
 106
 107     register_ioport_write(0xf1, 1, 1, test_device_serial_write, dev);
 108     register_ioport_write(0xf4, 1, 4, test_device_exit, dev);
 109     register_ioport_read(0xd1, 1, 4, test_device_memsize_read, dev);
 110     register_ioport_read(0xe0, 1, 1, test_device_ioport_read, dev);
 111     register_ioport_write(0xe0, 1, 1, test_device_ioport_write, dev);
 112     register_ioport_read(0xe0, 1, 2, test_device_ioport_read, dev);
 113     register_ioport_write(0xe0, 1, 2, test_device_ioport_write, dev);
 114     register_ioport_read(0xe0, 1, 4, test_device_ioport_read, dev);
 115     register_ioport_write(0xe0, 1, 4, test_device_ioport_write, dev);
 116     register_ioport_write(0xe4, 1, 4, test_device_flush_page, dev);
 117     register_ioport_write(0x2000, 24, 1, test_device_irq_line, NULL);
 118     iomem_buf = qemu_mallocz(0x10000);
 119     iomem = cpu_register_io_memory(test_iomem_read, test_iomem_write, NULL,
 120                                    DEVICE_NATIVE_ENDIAN);
 121     cpu_register_physical_memory(0xff000000, 0x10000, iomem);
 122     return 0;
 123 }
 124
 125 static ISADeviceInfo testdev_info = {
 126     .qdev.name  = "testdev",
 127     .qdev.size  = sizeof(struct testdev),
 128     .init       = init_test_device,
 129     .qdev.props = (Property[]) {
 130         DEFINE_PROP_CHR("chardev", struct testdev, chr),
 131         DEFINE_PROP_END_OF_LIST(),
 132     },
 133 };
 134
 135 static void testdev_register_devices(void)
 136 {
 137     isa_qdev_register(&testdev_info);
 138 }
 139
 140 device_init(testdev_register_devices)