hw/misc/pci-testdev.c

   1 /*
   2  * QEMU PCI test device
   3  *
   4  * Copyright (c) 2012 Red Hat Inc.
   5  * Author: Michael S. Tsirkin <[email protected]>
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License along
  18  * with this program; if not, see <http://www.gnu.org/licenses/>.
  19  */
  20 #include "qemu/osdep.h"
  21 #include "hw/hw.h"
  22 #include "hw/pci/pci.h"
  23 #include "qemu/event_notifier.h"
  24 #include "sysemu/kvm.h"
  25
  26 typedef struct PCITestDevHdr {
  27     uint8_t test;
  28     uint8_t width;
  29     uint8_t pad0[2];
  30     uint32_t offset;
  31     uint8_t data;
  32     uint8_t pad1[3];
  33     uint32_t count;
  34     uint8_t name[];
  35 } PCITestDevHdr;
  36
  37 typedef struct IOTest {
  38     MemoryRegion *mr;
  39     EventNotifier notifier;
  40     bool hasnotifier;
  41     unsigned size;
  42     bool match_data;
  43     PCITestDevHdr *hdr;
  44     unsigned bufsize;
  45 } IOTest;
  46
  47 #define IOTEST_DATAMATCH 0xFA
  48 #define IOTEST_NOMATCH   0xCE
  49
  50 #define IOTEST_IOSIZE 128
  51 #define IOTEST_MEMSIZE 2048
  52
  53 static const char *iotest_test[] = {
  54     "no-eventfd",
  55     "wildcard-eventfd",
  56     "datamatch-eventfd"
  57 };
  58
  59 static const char *iotest_type[] = {
  60     "mmio",
  61     "portio"
  62 };
  63
  64 #define IOTEST_TEST(i) (iotest_test[((i) % ARRAY_SIZE(iotest_test))])
  65 #define IOTEST_TYPE(i) (iotest_type[((i) / ARRAY_SIZE(iotest_test))])
  66 #define IOTEST_MAX_TEST (ARRAY_SIZE(iotest_test))
  67 #define IOTEST_MAX_TYPE (ARRAY_SIZE(iotest_type))
  68 #define IOTEST_MAX (IOTEST_MAX_TEST * IOTEST_MAX_TYPE)
  69
  70 enum {
  71     IOTEST_ACCESS_NAME,
  72     IOTEST_ACCESS_DATA,
  73     IOTEST_ACCESS_MAX,
  74 };
  75
  76 #define IOTEST_ACCESS_TYPE uint8_t
  77 #define IOTEST_ACCESS_WIDTH (sizeof(uint8_t))
  78
  79 typedef struct PCITestDevState {
  80     /*< private >*/
  81     PCIDevice parent_obj;
  82     /*< public >*/
  83
  84     MemoryRegion mmio;
  85     MemoryRegion portio;
  86     IOTest *tests;
  87     int current;
  88
  89     uint64_t membar_size;
  90     MemoryRegion membar;
  91 } PCITestDevState;
  92
  93 #define TYPE_PCI_TEST_DEV "pci-testdev"
  94
  95 #define PCI_TEST_DEV(obj) \
  96     OBJECT_CHECK(PCITestDevState, (obj), TYPE_PCI_TEST_DEV)
  97
  98 #define IOTEST_IS_MEM(i) (strcmp(IOTEST_TYPE(i), "portio"))
  99 #define IOTEST_REGION(d, i) (IOTEST_IS_MEM(i) ?  &(d)->mmio : &(d)->portio)
 100 #define IOTEST_SIZE(i) (IOTEST_IS_MEM(i) ? IOTEST_MEMSIZE : IOTEST_IOSIZE)
 101 #define IOTEST_PCI_BAR(i) (IOTEST_IS_MEM(i) ? PCI_BASE_ADDRESS_SPACE_MEMORY : \
 102                            PCI_BASE_ADDRESS_SPACE_IO)
 103
 104 static int pci_testdev_start(IOTest *test)
 105 {
 106     test->hdr->count = 0;
 107     if (!test->hasnotifier) {
 108         return 0;
 109     }
 110     event_notifier_test_and_clear(&test->notifier);
 111     memory_region_add_eventfd(test->mr,
 112                               le32_to_cpu(test->hdr->offset),
 113                               test->size,
 114                               test->match_data,
 115                               test->hdr->data,
 116                               &test->notifier);
 117     return 0;
 118 }
 119
 120 static void pci_testdev_stop(IOTest *test)
 121 {
 122     if (!test->hasnotifier) {
 123         return;
 124     }
 125     memory_region_del_eventfd(test->mr,
 126                               le32_to_cpu(test->hdr->offset),
 127                               test->size,
 128                               test->match_data,
 129                               test->hdr->data,
 130                               &test->notifier);
 131 }
 132
 133 static void
 134 pci_testdev_reset(PCITestDevState *d)
 135 {
 136     if (d->current == -1) {
 137         return;
 138     }
 139     pci_testdev_stop(&d->tests[d->current]);
 140     d->current = -1;
 141 }
 142
 143 static void pci_testdev_inc(IOTest *test, unsigned inc)
 144 {
 145     uint32_t c = le32_to_cpu(test->hdr->count);
 146     test->hdr->count = cpu_to_le32(c + inc);
 147 }
 148
 149 static void
 150 pci_testdev_write(void *opaque, hwaddr addr, uint64_t val,
 151                   unsigned size, int type)
 152 {
 153     PCITestDevState *d = opaque;
 154     IOTest *test;
 155     int t, r;
 156
 157     if (addr == offsetof(PCITestDevHdr, test)) {
 158         pci_testdev_reset(d);
 159         if (val >= IOTEST_MAX_TEST) {
 160             return;
 161         }
 162         t = type * IOTEST_MAX_TEST + val;
 163         r = pci_testdev_start(&d->tests[t]);
 164         if (r < 0) {
 165             return;
 166         }
 167         d->current = t;
 168         return;
 169     }
 170     if (d->current < 0) {
 171         return;
 172     }
 173     test = &d->tests[d->current];
 174     if (addr != le32_to_cpu(test->hdr->offset)) {
 175         return;
 176     }
 177     if (test->match_data && test->size != size) {
 178         return;
 179     }
 180     if (test->match_data && val != test->hdr->data) {
 181         return;
 182     }
 183     pci_testdev_inc(test, 1);
 184 }
 185
 186 static uint64_t
 187 pci_testdev_read(void *opaque, hwaddr addr, unsigned size)
 188 {
 189     PCITestDevState *d = opaque;
 190     const char *buf;
 191     IOTest *test;
 192     if (d->current < 0) {
 193         return 0;
 194     }
 195     test = &d->tests[d->current];
 196     buf = (const char *)test->hdr;
 197     if (addr + size >= test->bufsize) {
 198         return 0;
 199     }
 200     if (test->hasnotifier) {
 201         event_notifier_test_and_clear(&test->notifier);
 202     }
 203     return buf[addr];
 204 }
 205
 206 static void
 207 pci_testdev_mmio_write(void *opaque, hwaddr addr, uint64_t val,
 208                        unsigned size)
 209 {
 210     pci_testdev_write(opaque, addr, val, size, 0);
 211 }
 212
 213 static void
 214 pci_testdev_pio_write(void *opaque, hwaddr addr, uint64_t val,
 215                        unsigned size)
 216 {
 217     pci_testdev_write(opaque, addr, val, size, 1);
 218 }
 219
 220 static const MemoryRegionOps pci_testdev_mmio_ops = {
 221     .read = pci_testdev_read,
 222     .write = pci_testdev_mmio_write,
 223     .endianness = DEVICE_LITTLE_ENDIAN,
 224     .impl = {
 225         .min_access_size = 1,
 226         .max_access_size = 1,
 227     },
 228 };
 229
 230 static const MemoryRegionOps pci_testdev_pio_ops = {
 231     .read = pci_testdev_read,
 232     .write = pci_testdev_pio_write,
 233     .endianness = DEVICE_LITTLE_ENDIAN,
 234     .impl = {
 235         .min_access_size = 1,
 236         .max_access_size = 1,
 237     },
 238 };
 239
 240 static void pci_testdev_realize(PCIDevice *pci_dev, Error **errp)
 241 {
 242     PCITestDevState *d = PCI_TEST_DEV(pci_dev);
 243     uint8_t *pci_conf;
 244     char *name;
 245     int r, i;
 246     bool fastmmio = kvm_ioeventfd_any_length_enabled();
 247
 248     pci_conf = pci_dev->config;
 249
 250     pci_conf[PCI_INTERRUPT_PIN] = 0; /* no interrupt pin */
 251
 252     memory_region_init_io(&d->mmio, OBJECT(d), &pci_testdev_mmio_ops, d,
 253                           "pci-testdev-mmio", IOTEST_MEMSIZE * 2);
 254     memory_region_init_io(&d->portio, OBJECT(d), &pci_testdev_pio_ops, d,
 255                           "pci-testdev-portio", IOTEST_IOSIZE * 2);
 256     pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY, &d->mmio);
 257     pci_register_bar(pci_dev, 1, PCI_BASE_ADDRESS_SPACE_IO, &d->portio);
 258
 259     if (d->membar_size) {
 260         memory_region_init(&d->membar, OBJECT(d), "pci-testdev-membar",
 261                            d->membar_size);
 262         pci_register_bar(pci_dev, 2,
 263                          PCI_BASE_ADDRESS_SPACE_MEMORY |
 264                          PCI_BASE_ADDRESS_MEM_PREFETCH |
 265                          PCI_BASE_ADDRESS_MEM_TYPE_64,
 266                          &d->membar);
 267     }
 268
 269     d->current = -1;
 270     d->tests = g_malloc0(IOTEST_MAX * sizeof *d->tests);
 271     for (i = 0; i < IOTEST_MAX; ++i) {
 272         IOTest *test = &d->tests[i];
 273         name = g_strdup_printf("%s-%s", IOTEST_TYPE(i), IOTEST_TEST(i));
 274         test->bufsize = sizeof(PCITestDevHdr) + strlen(name) + 1;
 275         test->hdr = g_malloc0(test->bufsize);
 276         memcpy(test->hdr->name, name, strlen(name) + 1);
 277         g_free(name);
 278         test->hdr->offset = cpu_to_le32(IOTEST_SIZE(i) + i * IOTEST_ACCESS_WIDTH);
 279         test->match_data = strcmp(IOTEST_TEST(i), "wildcard-eventfd");
 280         if (fastmmio && IOTEST_IS_MEM(i) && !test->match_data) {
 281             test->size = 0;
 282         } else {
 283             test->size = IOTEST_ACCESS_WIDTH;
 284         }
 285         test->hdr->test = i;
 286         test->hdr->data = test->match_data ? IOTEST_DATAMATCH : IOTEST_NOMATCH;
 287         test->hdr->width = IOTEST_ACCESS_WIDTH;
 288         test->mr = IOTEST_REGION(d, i);
 289         if (!strcmp(IOTEST_TEST(i), "no-eventfd")) {
 290             test->hasnotifier = false;
 291             continue;
 292         }
 293         r = event_notifier_init(&test->notifier, 0);
 294         assert(r >= 0);
 295         test->hasnotifier = true;
 296     }
 297 }
 298
 299 static void
 300 pci_testdev_uninit(PCIDevice *dev)
 301 {
 302     PCITestDevState *d = PCI_TEST_DEV(dev);
 303     int i;
 304
 305     pci_testdev_reset(d);
 306     for (i = 0; i < IOTEST_MAX; ++i) {
 307         if (d->tests[i].hasnotifier) {
 308             event_notifier_cleanup(&d->tests[i].notifier);
 309         }
 310         g_free(d->tests[i].hdr);
 311     }
 312     g_free(d->tests);
 313 }
 314
 315 static void qdev_pci_testdev_reset(DeviceState *dev)
 316 {
 317     PCITestDevState *d = PCI_TEST_DEV(dev);
 318     pci_testdev_reset(d);
 319 }
 320
 321 static Property pci_testdev_properties[] = {
 322     DEFINE_PROP_SIZE("membar", PCITestDevState, membar_size, 0),
 323     DEFINE_PROP_END_OF_LIST(),
 324 };
 325
 326 static void pci_testdev_class_init(ObjectClass *klass, void *data)
 327 {
 328     DeviceClass *dc = DEVICE_CLASS(klass);
 329     PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
 330
 331     k->realize = pci_testdev_realize;
 332     k->exit = pci_testdev_uninit;
 333     k->vendor_id = PCI_VENDOR_ID_REDHAT;
 334     k->device_id = PCI_DEVICE_ID_REDHAT_TEST;
 335     k->revision = 0x00;
 336     k->class_id = PCI_CLASS_OTHERS;
 337     dc->desc = "PCI Test Device";
 338     set_bit(DEVICE_CATEGORY_MISC, dc->categories);
 339     dc->reset = qdev_pci_testdev_reset;
 340     dc->props = pci_testdev_properties;
 341 }
 342
 343 static const TypeInfo pci_testdev_info = {
 344     .name          = TYPE_PCI_TEST_DEV,
 345     .parent        = TYPE_PCI_DEVICE,
 346     .instance_size = sizeof(PCITestDevState),
 347     .class_init    = pci_testdev_class_init,
 348     .interfaces = (InterfaceInfo[]) {
 349         { INTERFACE_CONVENTIONAL_PCI_DEVICE },
 350         { },
 351     },
 352 };
 353
 354 static void pci_testdev_register_types(void)
 355 {
 356     type_register_static(&pci_testdev_info);
 357 }
 358
 359 type_init(pci_testdev_register_types)