tests/libqtest.c

   1 /*
   2  * QTest
   3  *
   4  * Copyright IBM, Corp. 2012
   5  * Copyright Red Hat, Inc. 2012
   6  *
   7  * Authors:
   8  *  Anthony Liguori   <[email protected]>
   9  *  Paolo Bonzini     <[email protected]>
  10  *
  11  * This work is licensed under the terms of the GNU GPL, version 2 or later.
  12  * See the COPYING file in the top-level directory.
  13  *
  14  */
  15 #include "libqtest.h"
  16
  17 #include <glib.h>
  18 #include <sys/types.h>
  19 #include <sys/socket.h>
  20 #include <sys/wait.h>
  21 #include <sys/un.h>
  22 #include <inttypes.h>
  23 #include <errno.h>
  24 #include <stdio.h>
  25 #include <stdlib.h>
  26 #include <unistd.h>
  27 #include <string.h>
  28
  29 #include "compiler.h"
  30 #include "osdep.h"
  31
  32 #define MAX_IRQ 256
  33
  34 QTestState *global_qtest;
  35
  36 struct QTestState
  37 {
  38     int fd;
  39     int qmp_fd;
  40     bool irq_level[MAX_IRQ];
  41     GString *rx;
  42     gchar *pid_file;
  43 };
  44
  45 #define g_assert_no_errno(ret) do { \
  46     g_assert_cmpint(ret, !=, -1); \
  47 } while (0)
  48
  49 static int init_socket(const char *socket_path)
  50 {
  51     struct sockaddr_un addr;
  52     int sock;
  53     int ret;
  54
  55     sock = socket(PF_UNIX, SOCK_STREAM, 0);
  56     g_assert_no_errno(sock);
  57
  58     addr.sun_family = AF_UNIX;
  59     snprintf(addr.sun_path, sizeof(addr.sun_path), "%s", socket_path);
  60     qemu_set_cloexec(sock);
  61
  62     do {
  63         ret = bind(sock, (struct sockaddr *)&addr, sizeof(addr));
  64     } while (ret == -1 && errno == EINTR);
  65     g_assert_no_errno(ret);
  66     listen(sock, 1);
  67
  68     return sock;
  69 }
  70
  71 static int socket_accept(int sock)
  72 {
  73     struct sockaddr_un addr;
  74     socklen_t addrlen;
  75     int ret;
  76
  77     addrlen = sizeof(addr);
  78     do {
  79         ret = accept(sock, (struct sockaddr *)&addr, &addrlen);
  80     } while (ret == -1 && errno == EINTR);
  81     g_assert_no_errno(ret);
  82     close(sock);
  83
  84     return ret;
  85 }
  86
  87 QTestState *qtest_init(const char *extra_args)
  88 {
  89     QTestState *s;
  90     int sock, qmpsock, ret, i;
  91     gchar *socket_path;
  92     gchar *qmp_socket_path;
  93     gchar *pid_file;
  94     gchar *command;
  95     const char *qemu_binary;
  96     pid_t pid;
  97
  98     qemu_binary = getenv("QTEST_QEMU_BINARY");
  99     g_assert(qemu_binary != NULL);
 100
 101     socket_path = g_strdup_printf("/tmp/qtest-%d.sock", getpid());
 102     qmp_socket_path = g_strdup_printf("/tmp/qtest-%d.qmp", getpid());
 103     pid_file = g_strdup_printf("/tmp/qtest-%d.pid", getpid());
 104
 105     s = g_malloc(sizeof(*s));
 106
 107     sock = init_socket(socket_path);
 108     qmpsock = init_socket(qmp_socket_path);
 109
 110     pid = fork();
 111     if (pid == 0) {
 112         command = g_strdup_printf("%s "
 113                                   "-qtest unix:%s,nowait "
 114                                   "-qtest-log /dev/null "
 115                                   "-qmp unix:%s,nowait "
 116                                   "-pidfile %s "
 117                                   "-machine accel=qtest "
 118                                   "%s", qemu_binary, socket_path,
 119                                   qmp_socket_path, pid_file,
 120                                   extra_args ?: "");
 121
 122         ret = system(command);
 123         exit(ret);
 124         g_free(command);
 125     }
 126
 127     s->fd = socket_accept(sock);
 128     s->qmp_fd = socket_accept(qmpsock);
 129
 130     s->rx = g_string_new("");
 131     s->pid_file = pid_file;
 132     for (i = 0; i < MAX_IRQ; i++) {
 133         s->irq_level[i] = false;
 134     }
 135
 136     g_free(socket_path);
 137     g_free(qmp_socket_path);
 138
 139     /* Read the QMP greeting and then do the handshake */
 140     qtest_qmp(s, "");
 141     qtest_qmp(s, "{ 'execute': 'qmp_capabilities' }");
 142
 143     return s;
 144 }
 145
 146 void qtest_quit(QTestState *s)
 147 {
 148     FILE *f;
 149     char buffer[1024];
 150
 151     f = fopen(s->pid_file, "r");
 152     if (f) {
 153         if (fgets(buffer, sizeof(buffer), f)) {
 154             pid_t pid = atoi(buffer);
 155             int status = 0;
 156
 157             kill(pid, SIGTERM);
 158             waitpid(pid, &status, 0);
 159         }
 160
 161         fclose(f);
 162     }
 163 }
 164
 165 static void socket_sendf(int fd, const char *fmt, va_list ap)
 166 {
 167     gchar *str;
 168     size_t size, offset;
 169
 170     str = g_strdup_vprintf(fmt, ap);
 171     size = strlen(str);
 172
 173     offset = 0;
 174     while (offset < size) {
 175         ssize_t len;
 176
 177         len = write(fd, str + offset, size - offset);
 178         if (len == -1 && errno == EINTR) {
 179             continue;
 180         }
 181
 182         g_assert_no_errno(len);
 183         g_assert_cmpint(len, >, 0);
 184
 185         offset += len;
 186     }
 187 }
 188
 189 static void GCC_FMT_ATTR(2, 3) qtest_sendf(QTestState *s, const char *fmt, ...)
 190 {
 191     va_list ap;
 192
 193     va_start(ap, fmt);
 194     socket_sendf(s->fd, fmt, ap);
 195     va_end(ap);
 196 }
 197
 198 static GString *qtest_recv_line(QTestState *s)
 199 {
 200     GString *line;
 201     size_t offset;
 202     char *eol;
 203
 204     while ((eol = strchr(s->rx->str, '\n')) == NULL) {
 205         ssize_t len;
 206         char buffer[1024];
 207
 208         len = read(s->fd, buffer, sizeof(buffer));
 209         if (len == -1 && errno == EINTR) {
 210             continue;
 211         }
 212
 213         if (len == -1 || len == 0) {
 214             fprintf(stderr, "Broken pipe\n");
 215             exit(1);
 216         }
 217
 218         g_string_append_len(s->rx, buffer, len);
 219     }
 220
 221     offset = eol - s->rx->str;
 222     line = g_string_new_len(s->rx->str, offset);
 223     g_string_erase(s->rx, 0, offset + 1);
 224
 225     return line;
 226 }
 227
 228 static gchar **qtest_rsp(QTestState *s, int expected_args)
 229 {
 230     GString *line;
 231     gchar **words;
 232     int i;
 233
 234 redo:
 235     line = qtest_recv_line(s);
 236     words = g_strsplit(line->str, " ", 0);
 237     g_string_free(line, TRUE);
 238
 239     if (strcmp(words[0], "IRQ") == 0) {
 240         int irq;
 241
 242         g_assert(words[1] != NULL);
 243         g_assert(words[2] != NULL);
 244
 245         irq = strtoul(words[2], NULL, 0);
 246         g_assert_cmpint(irq, >=, 0);
 247         g_assert_cmpint(irq, <, MAX_IRQ);
 248
 249         if (strcmp(words[1], "raise") == 0) {
 250             s->irq_level[irq] = true;
 251         } else {
 252             s->irq_level[irq] = false;
 253         }
 254
 255         g_strfreev(words);
 256         goto redo;
 257     }
 258
 259     g_assert(words[0] != NULL);
 260     g_assert_cmpstr(words[0], ==, "OK");
 261
 262     if (expected_args) {
 263         for (i = 0; i < expected_args; i++) {
 264             g_assert(words[i] != NULL);
 265         }
 266     } else {
 267         g_strfreev(words);
 268     }
 269
 270     return words;
 271 }
 272
 273 void qtest_qmp(QTestState *s, const char *fmt, ...)
 274 {
 275     va_list ap;
 276     bool has_reply = false;
 277     int nesting = 0;
 278
 279     /* Send QMP request */
 280     va_start(ap, fmt);
 281     socket_sendf(s->qmp_fd, fmt, ap);
 282     va_end(ap);
 283
 284     /* Receive reply */
 285     while (!has_reply || nesting > 0) {
 286         ssize_t len;
 287         char c;
 288
 289         len = read(s->qmp_fd, &c, 1);
 290         if (len == -1 && errno == EINTR) {
 291             continue;
 292         }
 293
 294         switch (c) {
 295         case '{':
 296             nesting++;
 297             has_reply = true;
 298             break;
 299         case '}':
 300             nesting--;
 301             break;
 302         }
 303     }
 304 }
 305
 306 const char *qtest_get_arch(void)
 307 {
 308     const char *qemu = getenv("QTEST_QEMU_BINARY");
 309     const char *end = strrchr(qemu, '/');
 310
 311     return end + strlen("/qemu-system-");
 312 }
 313
 314 bool qtest_get_irq(QTestState *s, int num)
 315 {
 316     /* dummy operation in order to make sure irq is up to date */
 317     qtest_inb(s, 0);
 318
 319     return s->irq_level[num];
 320 }
 321
 322 static int64_t qtest_clock_rsp(QTestState *s)
 323 {
 324     gchar **words;
 325     int64_t clock;
 326     words = qtest_rsp(s, 2);
 327     clock = g_ascii_strtoll(words[1], NULL, 0);
 328     g_strfreev(words);
 329     return clock;
 330 }
 331
 332 int64_t qtest_clock_step_next(QTestState *s)
 333 {
 334     qtest_sendf(s, "clock_step\n");
 335     return qtest_clock_rsp(s);
 336 }
 337
 338 int64_t qtest_clock_step(QTestState *s, int64_t step)
 339 {
 340     qtest_sendf(s, "clock_step %"PRIi64"\n", step);
 341     return qtest_clock_rsp(s);
 342 }
 343
 344 int64_t qtest_clock_set(QTestState *s, int64_t val)
 345 {
 346     qtest_sendf(s, "clock_set %"PRIi64"\n", val);
 347     return qtest_clock_rsp(s);
 348 }
 349
 350 void qtest_irq_intercept_out(QTestState *s, const char *qom_path)
 351 {
 352     qtest_sendf(s, "irq_intercept_out %s\n", qom_path);
 353     qtest_rsp(s, 0);
 354 }
 355
 356 void qtest_irq_intercept_in(QTestState *s, const char *qom_path)
 357 {
 358     qtest_sendf(s, "irq_intercept_in %s\n", qom_path);
 359     qtest_rsp(s, 0);
 360 }
 361
 362 static void qtest_out(QTestState *s, const char *cmd, uint16_t addr, uint32_t value)
 363 {
 364     qtest_sendf(s, "%s 0x%x 0x%x\n", cmd, addr, value);
 365     qtest_rsp(s, 0);
 366 }
 367
 368 void qtest_outb(QTestState *s, uint16_t addr, uint8_t value)
 369 {
 370     qtest_out(s, "outb", addr, value);
 371 }
 372
 373 void qtest_outw(QTestState *s, uint16_t addr, uint16_t value)
 374 {
 375     qtest_out(s, "outw", addr, value);
 376 }
 377
 378 void qtest_outl(QTestState *s, uint16_t addr, uint32_t value)
 379 {
 380     qtest_out(s, "outl", addr, value);
 381 }
 382
 383 static uint32_t qtest_in(QTestState *s, const char *cmd, uint16_t addr)
 384 {
 385     gchar **args;
 386     uint32_t value;
 387
 388     qtest_sendf(s, "%s 0x%x\n", cmd, addr);
 389     args = qtest_rsp(s, 2);
 390     value = strtoul(args[1], NULL, 0);
 391     g_strfreev(args);
 392
 393     return value;
 394 }
 395
 396 uint8_t qtest_inb(QTestState *s, uint16_t addr)
 397 {
 398     return qtest_in(s, "inb", addr);
 399 }
 400
 401 uint16_t qtest_inw(QTestState *s, uint16_t addr)
 402 {
 403     return qtest_in(s, "inw", addr);
 404 }
 405
 406 uint32_t qtest_inl(QTestState *s, uint16_t addr)
 407 {
 408     return qtest_in(s, "inl", addr);
 409 }
 410
 411 static int hex2nib(char ch)
 412 {
 413     if (ch >= '0' && ch <= '9') {
 414         return ch - '0';
 415     } else if (ch >= 'a' && ch <= 'f') {
 416         return 10 + (ch - 'a');
 417     } else if (ch >= 'A' && ch <= 'F') {
 418         return 10 + (ch - 'a');
 419     } else {
 420         return -1;
 421     }
 422 }
 423
 424 void qtest_memread(QTestState *s, uint64_t addr, void *data, size_t size)
 425 {
 426     uint8_t *ptr = data;
 427     gchar **args;
 428     size_t i;
 429
 430     qtest_sendf(s, "read 0x%" PRIx64 " 0x%zx\n", addr, size);
 431     args = qtest_rsp(s, 2);
 432
 433     for (i = 0; i < size; i++) {
 434         ptr[i] = hex2nib(args[1][2 + (i * 2)]) << 4;
 435         ptr[i] |= hex2nib(args[1][2 + (i * 2) + 1]);
 436     }
 437
 438     g_strfreev(args);
 439 }
 440
 441 void qtest_add_func(const char *str, void (*fn))
 442 {
 443     gchar *path = g_strdup_printf("/%s/%s", qtest_get_arch(), str);
 444     g_test_add_func(path, fn);
 445 }
 446
 447 void qtest_memwrite(QTestState *s, uint64_t addr, const void *data, size_t size)
 448 {
 449     const uint8_t *ptr = data;
 450     size_t i;
 451
 452     qtest_sendf(s, "write 0x%" PRIx64 " 0x%zx 0x", addr, size);
 453     for (i = 0; i < size; i++) {
 454         qtest_sendf(s, "%02x", ptr[i]);
 455     }
 456     qtest_sendf(s, "\n");
 457     qtest_rsp(s, 0);
 458 }