tests/ivshmem-test.c

   1 /*
   2  * QTest testcase for ivshmem
   3  *
   4  * Copyright (c) 2014 SUSE LINUX Products GmbH
   5  * Copyright (c) 2015 Red Hat, Inc.
   6  *
   7  * This work is licensed under the terms of the GNU GPL, version 2 or later.
   8  * See the COPYING file in the top-level directory.
   9  */
  10
  11 #include "qemu/osdep.h"
  12 #include <glib/gstdio.h>
  13 #include "contrib/ivshmem-server/ivshmem-server.h"
  14 #include "libqos/libqos-pc.h"
  15 #include "libqos/libqos-spapr.h"
  16 #include "libqtest.h"
  17 #include "qemu-common.h"
  18
  19 #define TMPSHMSIZE (1 << 20)
  20 static char *tmpshm;
  21 static void *tmpshmem;
  22 static char *tmpdir;
  23 static char *tmpserver;
  24
  25 static void save_fn(QPCIDevice *dev, int devfn, void *data)
  26 {
  27     QPCIDevice **pdev = (QPCIDevice **) data;
  28
  29     *pdev = dev;
  30 }
  31
  32 static QPCIDevice *get_device(QPCIBus *pcibus)
  33 {
  34     QPCIDevice *dev;
  35
  36     dev = NULL;
  37     qpci_device_foreach(pcibus, 0x1af4, 0x1110, save_fn, &dev);
  38     g_assert(dev != NULL);
  39
  40     return dev;
  41 }
  42
  43 typedef struct _IVState {
  44     QOSState *qs;
  45     QPCIBar reg_bar, mem_bar;
  46     QPCIDevice *dev;
  47 } IVState;
  48
  49 enum Reg {
  50     INTRMASK = 0,
  51     INTRSTATUS = 4,
  52     IVPOSITION = 8,
  53     DOORBELL = 12,
  54 };
  55
  56 static const char* reg2str(enum Reg reg) {
  57     switch (reg) {
  58     case INTRMASK:
  59         return "IntrMask";
  60     case INTRSTATUS:
  61         return "IntrStatus";
  62     case IVPOSITION:
  63         return "IVPosition";
  64     case DOORBELL:
  65         return "DoorBell";
  66     default:
  67         return NULL;
  68     }
  69 }
  70
  71 static inline unsigned in_reg(IVState *s, enum Reg reg)
  72 {
  73     const char *name = reg2str(reg);
  74     unsigned res;
  75
  76     res = qpci_io_readl(s->dev, s->reg_bar, reg);
  77     g_test_message("*%s -> %x\n", name, res);
  78
  79     return res;
  80 }
  81
  82 static inline void out_reg(IVState *s, enum Reg reg, unsigned v)
  83 {
  84     const char *name = reg2str(reg);
  85
  86     g_test_message("%x -> *%s\n", v, name);
  87     qpci_io_writel(s->dev, s->reg_bar, reg, v);
  88 }
  89
  90 static inline void read_mem(IVState *s, uint64_t off, void *buf, size_t len)
  91 {
  92     qpci_memread(s->dev, s->mem_bar, off, buf, len);
  93 }
  94
  95 static inline void write_mem(IVState *s, uint64_t off,
  96                              const void *buf, size_t len)
  97 {
  98     qpci_memwrite(s->dev, s->mem_bar, off, buf, len);
  99 }
 100
 101 static void cleanup_vm(IVState *s)
 102 {
 103     assert(!global_qtest);
 104     g_free(s->dev);
 105     qtest_shutdown(s->qs);
 106 }
 107
 108 static void setup_vm_cmd(IVState *s, const char *cmd, bool msix)
 109 {
 110     uint64_t barsize;
 111     const char *arch = qtest_get_arch();
 112
 113     if (strcmp(arch, "i386") == 0 || strcmp(arch, "x86_64") == 0) {
 114         s->qs = qtest_pc_boot(cmd);
 115     } else if (strcmp(arch, "ppc64") == 0) {
 116         s->qs = qtest_spapr_boot(cmd);
 117     } else {
 118         g_printerr("ivshmem-test tests are only available on x86 or ppc64\n");
 119         exit(EXIT_FAILURE);
 120     }
 121     s->dev = get_device(s->qs->pcibus);
 122
 123     s->reg_bar = qpci_iomap(s->dev, 0, &barsize);
 124     g_assert_cmpuint(barsize, ==, 256);
 125
 126     if (msix) {
 127         qpci_msix_enable(s->dev);
 128     }
 129
 130     s->mem_bar = qpci_iomap(s->dev, 2, &barsize);
 131     g_assert_cmpuint(barsize, ==, TMPSHMSIZE);
 132
 133     qpci_device_enable(s->dev);
 134 }
 135
 136 static void setup_vm(IVState *s)
 137 {
 138     char *cmd = g_strdup_printf("-object memory-backend-file"
 139                                 ",id=mb1,size=1M,share,mem-path=/dev/shm%s"
 140                                 " -device ivshmem-plain,memdev=mb1", tmpshm);
 141
 142     setup_vm_cmd(s, cmd, false);
 143
 144     g_free(cmd);
 145 }
 146
 147 static void test_ivshmem_single(void)
 148 {
 149     IVState state, *s;
 150     uint32_t data[1024];
 151     int i;
 152
 153     setup_vm(&state);
 154     s = &state;
 155
 156     /* initial state of readable registers */
 157     g_assert_cmpuint(in_reg(s, INTRMASK), ==, 0);
 158     g_assert_cmpuint(in_reg(s, INTRSTATUS), ==, 0);
 159     g_assert_cmpuint(in_reg(s, IVPOSITION), ==, 0);
 160
 161     /* trigger interrupt via registers */
 162     out_reg(s, INTRMASK, 0xffffffff);
 163     g_assert_cmpuint(in_reg(s, INTRMASK), ==, 0xffffffff);
 164     out_reg(s, INTRSTATUS, 1);
 165     /* check interrupt status */
 166     g_assert_cmpuint(in_reg(s, INTRSTATUS), ==, 1);
 167     /* reading clears */
 168     g_assert_cmpuint(in_reg(s, INTRSTATUS), ==, 0);
 169     /* TODO intercept actual interrupt (needs qtest work) */
 170
 171     /* invalid register access */
 172     out_reg(s, IVPOSITION, 1);
 173     in_reg(s, DOORBELL);
 174
 175     /* ring the (non-functional) doorbell */
 176     out_reg(s, DOORBELL, 8 << 16);
 177
 178     /* write shared memory */
 179     for (i = 0; i < G_N_ELEMENTS(data); i++) {
 180         data[i] = i;
 181     }
 182     write_mem(s, 0, data, sizeof(data));
 183
 184     /* verify write */
 185     for (i = 0; i < G_N_ELEMENTS(data); i++) {
 186         g_assert_cmpuint(((uint32_t *)tmpshmem)[i], ==, i);
 187     }
 188
 189     /* read it back and verify read */
 190     memset(data, 0, sizeof(data));
 191     read_mem(s, 0, data, sizeof(data));
 192     for (i = 0; i < G_N_ELEMENTS(data); i++) {
 193         g_assert_cmpuint(data[i], ==, i);
 194     }
 195
 196     cleanup_vm(s);
 197 }
 198
 199 static void test_ivshmem_pair(void)
 200 {
 201     IVState state1, state2, *s1, *s2;
 202     char *data;
 203     int i;
 204
 205     setup_vm(&state1);
 206     s1 = &state1;
 207     setup_vm(&state2);
 208     s2 = &state2;
 209
 210     data = g_malloc0(TMPSHMSIZE);
 211
 212     /* host write, guest 1 & 2 read */
 213     memset(tmpshmem, 0x42, TMPSHMSIZE);
 214     read_mem(s1, 0, data, TMPSHMSIZE);
 215     for (i = 0; i < TMPSHMSIZE; i++) {
 216         g_assert_cmpuint(data[i], ==, 0x42);
 217     }
 218     read_mem(s2, 0, data, TMPSHMSIZE);
 219     for (i = 0; i < TMPSHMSIZE; i++) {
 220         g_assert_cmpuint(data[i], ==, 0x42);
 221     }
 222
 223     /* guest 1 write, guest 2 read */
 224     memset(data, 0x43, TMPSHMSIZE);
 225     write_mem(s1, 0, data, TMPSHMSIZE);
 226     memset(data, 0, TMPSHMSIZE);
 227     read_mem(s2, 0, data, TMPSHMSIZE);
 228     for (i = 0; i < TMPSHMSIZE; i++) {
 229         g_assert_cmpuint(data[i], ==, 0x43);
 230     }
 231
 232     /* guest 2 write, guest 1 read */
 233     memset(data, 0x44, TMPSHMSIZE);
 234     write_mem(s2, 0, data, TMPSHMSIZE);
 235     memset(data, 0, TMPSHMSIZE);
 236     read_mem(s1, 0, data, TMPSHMSIZE);
 237     for (i = 0; i < TMPSHMSIZE; i++) {
 238         g_assert_cmpuint(data[i], ==, 0x44);
 239     }
 240
 241     cleanup_vm(s1);
 242     cleanup_vm(s2);
 243     g_free(data);
 244 }
 245
 246 typedef struct ServerThread {
 247     GThread *thread;
 248     IvshmemServer *server;
 249     int pipe[2]; /* to handle quit */
 250 } ServerThread;
 251
 252 static void *server_thread(void *data)
 253 {
 254     ServerThread *t = data;
 255     IvshmemServer *server = t->server;
 256
 257     while (true) {
 258         fd_set fds;
 259         int maxfd, ret;
 260
 261         FD_ZERO(&fds);
 262         FD_SET(t->pipe[0], &fds);
 263         maxfd = t->pipe[0] + 1;
 264
 265         ivshmem_server_get_fds(server, &fds, &maxfd);
 266
 267         ret = select(maxfd, &fds, NULL, NULL, NULL);
 268
 269         if (ret < 0) {
 270             if (errno == EINTR) {
 271                 continue;
 272             }
 273
 274             g_critical("select error: %s\n", strerror(errno));
 275             break;
 276         }
 277         if (ret == 0) {
 278             continue;
 279         }
 280
 281         if (FD_ISSET(t->pipe[0], &fds)) {
 282             break;
 283         }
 284
 285         if (ivshmem_server_handle_fds(server, &fds, maxfd) < 0) {
 286             g_critical("ivshmem_server_handle_fds() failed\n");
 287             break;
 288         }
 289     }
 290
 291     return NULL;
 292 }
 293
 294 static void setup_vm_with_server(IVState *s, int nvectors)
 295 {
 296     char *cmd;
 297
 298     cmd = g_strdup_printf("-chardev socket,id=chr0,path=%s "
 299                           "-device ivshmem-doorbell,chardev=chr0,vectors=%d",
 300                           tmpserver, nvectors);
 301
 302     setup_vm_cmd(s, cmd, true);
 303
 304     g_free(cmd);
 305 }
 306
 307 static void test_ivshmem_server(void)
 308 {
 309     IVState state1, state2, *s1, *s2;
 310     ServerThread thread;
 311     IvshmemServer server;
 312     int ret, vm1, vm2;
 313     int nvectors = 2;
 314     guint64 end_time = g_get_monotonic_time() + 5 * G_TIME_SPAN_SECOND;
 315
 316     ret = ivshmem_server_init(&server, tmpserver, tmpshm, true,
 317                               TMPSHMSIZE, nvectors,
 318                               g_test_verbose());
 319     g_assert_cmpint(ret, ==, 0);
 320
 321     ret = ivshmem_server_start(&server);
 322     g_assert_cmpint(ret, ==, 0);
 323
 324     thread.server = &server;
 325     ret = pipe(thread.pipe);
 326     g_assert_cmpint(ret, ==, 0);
 327     thread.thread = g_thread_new("ivshmem-server", server_thread, &thread);
 328     g_assert(thread.thread != NULL);
 329
 330     setup_vm_with_server(&state1, nvectors);
 331     s1 = &state1;
 332     setup_vm_with_server(&state2, nvectors);
 333     s2 = &state2;
 334
 335     /* check got different VM ids */
 336     vm1 = in_reg(s1, IVPOSITION);
 337     vm2 = in_reg(s2, IVPOSITION);
 338     g_assert_cmpint(vm1, >=, 0);
 339     g_assert_cmpint(vm2, >=, 0);
 340     g_assert_cmpint(vm1, !=, vm2);
 341
 342     /* check number of MSI-X vectors */
 343     ret = qpci_msix_table_size(s1->dev);
 344     g_assert_cmpuint(ret, ==, nvectors);
 345
 346     /* TODO test behavior before MSI-X is enabled */
 347
 348     /* ping vm2 -> vm1 on vector 0 */
 349     ret = qpci_msix_pending(s1->dev, 0);
 350     g_assert_cmpuint(ret, ==, 0);
 351     out_reg(s2, DOORBELL, vm1 << 16);
 352     do {
 353         g_usleep(10000);
 354         ret = qpci_msix_pending(s1->dev, 0);
 355     } while (ret == 0 && g_get_monotonic_time() < end_time);
 356     g_assert_cmpuint(ret, !=, 0);
 357
 358     /* ping vm1 -> vm2 on vector 1 */
 359     ret = qpci_msix_pending(s2->dev, 1);
 360     g_assert_cmpuint(ret, ==, 0);
 361     out_reg(s1, DOORBELL, vm2 << 16 | 1);
 362     do {
 363         g_usleep(10000);
 364         ret = qpci_msix_pending(s2->dev, 1);
 365     } while (ret == 0 && g_get_monotonic_time() < end_time);
 366     g_assert_cmpuint(ret, !=, 0);
 367
 368     cleanup_vm(s2);
 369     cleanup_vm(s1);
 370
 371     if (qemu_write_full(thread.pipe[1], "q", 1) != 1) {
 372         g_error("qemu_write_full: %s", g_strerror(errno));
 373     }
 374
 375     g_thread_join(thread.thread);
 376
 377     ivshmem_server_close(&server);
 378     close(thread.pipe[1]);
 379     close(thread.pipe[0]);
 380 }
 381
 382 #define PCI_SLOT_HP             0x06
 383
 384 static void test_ivshmem_hotplug(void)
 385 {
 386     const char *arch = qtest_get_arch();
 387
 388     qtest_start("-object memory-backend-ram,size=1M,id=mb1");
 389
 390     qtest_qmp_device_add("ivshmem-plain", "iv1",
 391                          "{'addr': %s, 'memdev': 'mb1'}",
 392                          stringify(PCI_SLOT_HP));
 393     if (strcmp(arch, "ppc64") != 0) {
 394         qpci_unplug_acpi_device_test("iv1", PCI_SLOT_HP);
 395     }
 396
 397     qtest_end();
 398 }
 399
 400 static void test_ivshmem_memdev(void)
 401 {
 402     IVState state;
 403
 404     /* just for the sake of checking memory-backend property */
 405     setup_vm_cmd(&state, "-object memory-backend-ram,size=1M,id=mb1"
 406                  " -device ivshmem-plain,memdev=mb1", false);
 407
 408     cleanup_vm(&state);
 409 }
 410
 411 static void cleanup(void)
 412 {
 413     if (tmpshmem) {
 414         munmap(tmpshmem, TMPSHMSIZE);
 415         tmpshmem = NULL;
 416     }
 417
 418     if (tmpshm) {
 419         shm_unlink(tmpshm);
 420         g_free(tmpshm);
 421         tmpshm = NULL;
 422     }
 423
 424     if (tmpserver) {
 425         g_unlink(tmpserver);
 426         g_free(tmpserver);
 427         tmpserver = NULL;
 428     }
 429
 430     if (tmpdir) {
 431         g_rmdir(tmpdir);
 432         tmpdir = NULL;
 433     }
 434 }
 435
 436 static void abrt_handler(void *data)
 437 {
 438     cleanup();
 439 }
 440
 441 static gchar *mktempshm(int size, int *fd)
 442 {
 443     while (true) {
 444         gchar *name;
 445
 446         name = g_strdup_printf("/qtest-%u-%u", getpid(), g_random_int());
 447         *fd = shm_open(name, O_CREAT|O_RDWR|O_EXCL,
 448                        S_IRWXU|S_IRWXG|S_IRWXO);
 449         if (*fd > 0) {
 450             g_assert(ftruncate(*fd, size) == 0);
 451             return name;
 452         }
 453
 454         g_free(name);
 455
 456         if (errno != EEXIST) {
 457             perror("shm_open");
 458             return NULL;
 459         }
 460     }
 461 }
 462
 463 int main(int argc, char **argv)
 464 {
 465     int ret, fd;
 466     const char *arch = qtest_get_arch();
 467     gchar dir[] = "/tmp/ivshmem-test.XXXXXX";
 468
 469     g_test_init(&argc, &argv, NULL);
 470
 471     qtest_add_abrt_handler(abrt_handler, NULL);
 472     /* shm */
 473     tmpshm = mktempshm(TMPSHMSIZE, &fd);
 474     if (!tmpshm) {
 475         goto out;
 476     }
 477     tmpshmem = mmap(0, TMPSHMSIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, 0);
 478     g_assert(tmpshmem != MAP_FAILED);
 479     /* server */
 480     if (mkdtemp(dir) == NULL) {
 481         g_error("mkdtemp: %s", g_strerror(errno));
 482     }
 483     tmpdir = dir;
 484     tmpserver = g_strconcat(tmpdir, "/server", NULL);
 485
 486     qtest_add_func("/ivshmem/single", test_ivshmem_single);
 487     qtest_add_func("/ivshmem/hotplug", test_ivshmem_hotplug);
 488     qtest_add_func("/ivshmem/memdev", test_ivshmem_memdev);
 489     if (g_test_slow()) {
 490         qtest_add_func("/ivshmem/pair", test_ivshmem_pair);
 491         if (strcmp(arch, "ppc64") != 0) {
 492             qtest_add_func("/ivshmem/server", test_ivshmem_server);
 493         }
 494     }
 495
 496 out:
 497     ret = g_test_run();
 498     cleanup();
 499     return ret;
 500 }