547 lines
12 KiB
C
547 lines
12 KiB
C
/*
|
|
* QTest
|
|
*
|
|
* Copyright IBM, Corp. 2012
|
|
* Copyright Red Hat, Inc. 2012
|
|
* Copyright SUSE LINUX Products GmbH 2013
|
|
*
|
|
* Authors:
|
|
* Anthony Liguori <aliguori@us.ibm.com>
|
|
* Paolo Bonzini <pbonzini@redhat.com>
|
|
* Andreas Färber <afaerber@suse.de>
|
|
*
|
|
* This work is licensed under the terms of the GNU GPL, version 2 or later.
|
|
* See the COPYING file in the top-level directory.
|
|
*
|
|
*/
|
|
#include "libqtest.h"
|
|
|
|
#include <glib.h>
|
|
#include <sys/types.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/wait.h>
|
|
#include <sys/un.h>
|
|
#include <inttypes.h>
|
|
#include <errno.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
|
|
#include "qemu/compiler.h"
|
|
#include "qemu/osdep.h"
|
|
|
|
#define MAX_IRQ 256
|
|
|
|
QTestState *global_qtest;
|
|
|
|
struct QTestState
|
|
{
|
|
int fd;
|
|
int qmp_fd;
|
|
bool irq_level[MAX_IRQ];
|
|
GString *rx;
|
|
gchar *pid_file; /* QEMU PID file */
|
|
int child_pid; /* Child process created to execute QEMU */
|
|
char *socket_path, *qmp_socket_path;
|
|
};
|
|
|
|
#define g_assert_no_errno(ret) do { \
|
|
g_assert_cmpint(ret, !=, -1); \
|
|
} while (0)
|
|
|
|
static int init_socket(const char *socket_path)
|
|
{
|
|
struct sockaddr_un addr;
|
|
int sock;
|
|
int ret;
|
|
|
|
sock = socket(PF_UNIX, SOCK_STREAM, 0);
|
|
g_assert_no_errno(sock);
|
|
|
|
addr.sun_family = AF_UNIX;
|
|
snprintf(addr.sun_path, sizeof(addr.sun_path), "%s", socket_path);
|
|
qemu_set_cloexec(sock);
|
|
|
|
do {
|
|
ret = bind(sock, (struct sockaddr *)&addr, sizeof(addr));
|
|
} while (ret == -1 && errno == EINTR);
|
|
g_assert_no_errno(ret);
|
|
listen(sock, 1);
|
|
|
|
return sock;
|
|
}
|
|
|
|
static int socket_accept(int sock)
|
|
{
|
|
struct sockaddr_un addr;
|
|
socklen_t addrlen;
|
|
int ret;
|
|
|
|
addrlen = sizeof(addr);
|
|
do {
|
|
ret = accept(sock, (struct sockaddr *)&addr, &addrlen);
|
|
} while (ret == -1 && errno == EINTR);
|
|
g_assert_no_errno(ret);
|
|
close(sock);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static pid_t qtest_qemu_pid(QTestState *s)
|
|
{
|
|
FILE *f;
|
|
char buffer[1024];
|
|
pid_t pid = -1;
|
|
|
|
f = fopen(s->pid_file, "r");
|
|
if (f) {
|
|
if (fgets(buffer, sizeof(buffer), f)) {
|
|
pid = atoi(buffer);
|
|
}
|
|
fclose(f);
|
|
}
|
|
return pid;
|
|
}
|
|
|
|
QTestState *qtest_init(const char *extra_args)
|
|
{
|
|
QTestState *s;
|
|
int sock, qmpsock, i;
|
|
gchar *pid_file;
|
|
gchar *command;
|
|
const char *qemu_binary;
|
|
pid_t pid;
|
|
|
|
qemu_binary = getenv("QTEST_QEMU_BINARY");
|
|
g_assert(qemu_binary != NULL);
|
|
|
|
s = g_malloc(sizeof(*s));
|
|
|
|
s->socket_path = g_strdup_printf("/tmp/qtest-%d.sock", getpid());
|
|
s->qmp_socket_path = g_strdup_printf("/tmp/qtest-%d.qmp", getpid());
|
|
pid_file = g_strdup_printf("/tmp/qtest-%d.pid", getpid());
|
|
|
|
sock = init_socket(s->socket_path);
|
|
qmpsock = init_socket(s->qmp_socket_path);
|
|
|
|
pid = fork();
|
|
if (pid == 0) {
|
|
command = g_strdup_printf("%s "
|
|
"-qtest unix:%s,nowait "
|
|
"-qtest-log /dev/null "
|
|
"-qmp unix:%s,nowait "
|
|
"-pidfile %s "
|
|
"-machine accel=qtest "
|
|
"%s", qemu_binary, s->socket_path,
|
|
s->qmp_socket_path, pid_file,
|
|
extra_args ?: "");
|
|
execlp("/bin/sh", "sh", "-c", command, NULL);
|
|
exit(1);
|
|
}
|
|
|
|
s->fd = socket_accept(sock);
|
|
s->qmp_fd = socket_accept(qmpsock);
|
|
|
|
s->rx = g_string_new("");
|
|
s->pid_file = pid_file;
|
|
s->child_pid = pid;
|
|
for (i = 0; i < MAX_IRQ; i++) {
|
|
s->irq_level[i] = false;
|
|
}
|
|
|
|
/* Read the QMP greeting and then do the handshake */
|
|
qtest_qmp(s, "");
|
|
qtest_qmp(s, "{ 'execute': 'qmp_capabilities' }");
|
|
|
|
if (getenv("QTEST_STOP")) {
|
|
kill(qtest_qemu_pid(s), SIGSTOP);
|
|
}
|
|
|
|
return s;
|
|
}
|
|
|
|
void qtest_quit(QTestState *s)
|
|
{
|
|
int status;
|
|
|
|
pid_t pid = qtest_qemu_pid(s);
|
|
if (pid != -1) {
|
|
kill(pid, SIGTERM);
|
|
waitpid(pid, &status, 0);
|
|
}
|
|
|
|
unlink(s->pid_file);
|
|
unlink(s->socket_path);
|
|
unlink(s->qmp_socket_path);
|
|
g_free(s->pid_file);
|
|
g_free(s->socket_path);
|
|
g_free(s->qmp_socket_path);
|
|
}
|
|
|
|
static void socket_sendf(int fd, const char *fmt, va_list ap)
|
|
{
|
|
gchar *str;
|
|
size_t size, offset;
|
|
|
|
str = g_strdup_vprintf(fmt, ap);
|
|
size = strlen(str);
|
|
|
|
offset = 0;
|
|
while (offset < size) {
|
|
ssize_t len;
|
|
|
|
len = write(fd, str + offset, size - offset);
|
|
if (len == -1 && errno == EINTR) {
|
|
continue;
|
|
}
|
|
|
|
g_assert_no_errno(len);
|
|
g_assert_cmpint(len, >, 0);
|
|
|
|
offset += len;
|
|
}
|
|
}
|
|
|
|
static void GCC_FMT_ATTR(2, 3) qtest_sendf(QTestState *s, const char *fmt, ...)
|
|
{
|
|
va_list ap;
|
|
|
|
va_start(ap, fmt);
|
|
socket_sendf(s->fd, fmt, ap);
|
|
va_end(ap);
|
|
}
|
|
|
|
static GString *qtest_recv_line(QTestState *s)
|
|
{
|
|
GString *line;
|
|
size_t offset;
|
|
char *eol;
|
|
|
|
while ((eol = strchr(s->rx->str, '\n')) == NULL) {
|
|
ssize_t len;
|
|
char buffer[1024];
|
|
|
|
len = read(s->fd, buffer, sizeof(buffer));
|
|
if (len == -1 && errno == EINTR) {
|
|
continue;
|
|
}
|
|
|
|
if (len == -1 || len == 0) {
|
|
fprintf(stderr, "Broken pipe\n");
|
|
exit(1);
|
|
}
|
|
|
|
g_string_append_len(s->rx, buffer, len);
|
|
}
|
|
|
|
offset = eol - s->rx->str;
|
|
line = g_string_new_len(s->rx->str, offset);
|
|
g_string_erase(s->rx, 0, offset + 1);
|
|
|
|
return line;
|
|
}
|
|
|
|
static gchar **qtest_rsp(QTestState *s, int expected_args)
|
|
{
|
|
GString *line;
|
|
gchar **words;
|
|
int i;
|
|
|
|
redo:
|
|
line = qtest_recv_line(s);
|
|
words = g_strsplit(line->str, " ", 0);
|
|
g_string_free(line, TRUE);
|
|
|
|
if (strcmp(words[0], "IRQ") == 0) {
|
|
int irq;
|
|
|
|
g_assert(words[1] != NULL);
|
|
g_assert(words[2] != NULL);
|
|
|
|
irq = strtoul(words[2], NULL, 0);
|
|
g_assert_cmpint(irq, >=, 0);
|
|
g_assert_cmpint(irq, <, MAX_IRQ);
|
|
|
|
if (strcmp(words[1], "raise") == 0) {
|
|
s->irq_level[irq] = true;
|
|
} else {
|
|
s->irq_level[irq] = false;
|
|
}
|
|
|
|
g_strfreev(words);
|
|
goto redo;
|
|
}
|
|
|
|
g_assert(words[0] != NULL);
|
|
g_assert_cmpstr(words[0], ==, "OK");
|
|
|
|
if (expected_args) {
|
|
for (i = 0; i < expected_args; i++) {
|
|
g_assert(words[i] != NULL);
|
|
}
|
|
} else {
|
|
g_strfreev(words);
|
|
}
|
|
|
|
return words;
|
|
}
|
|
|
|
void qtest_qmpv(QTestState *s, const char *fmt, va_list ap)
|
|
{
|
|
bool has_reply = false;
|
|
int nesting = 0;
|
|
|
|
/* Send QMP request */
|
|
socket_sendf(s->qmp_fd, fmt, ap);
|
|
|
|
/* Receive reply */
|
|
while (!has_reply || nesting > 0) {
|
|
ssize_t len;
|
|
char c;
|
|
|
|
len = read(s->qmp_fd, &c, 1);
|
|
if (len == -1 && errno == EINTR) {
|
|
continue;
|
|
}
|
|
|
|
if (len == -1 || len == 0) {
|
|
fprintf(stderr, "Broken pipe\n");
|
|
exit(1);
|
|
}
|
|
|
|
switch (c) {
|
|
case '{':
|
|
nesting++;
|
|
has_reply = true;
|
|
break;
|
|
case '}':
|
|
nesting--;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void qtest_qmp(QTestState *s, const char *fmt, ...)
|
|
{
|
|
va_list ap;
|
|
|
|
va_start(ap, fmt);
|
|
qtest_qmpv(s, fmt, ap);
|
|
va_end(ap);
|
|
}
|
|
|
|
const char *qtest_get_arch(void)
|
|
{
|
|
const char *qemu = getenv("QTEST_QEMU_BINARY");
|
|
const char *end = strrchr(qemu, '/');
|
|
|
|
return end + strlen("/qemu-system-");
|
|
}
|
|
|
|
bool qtest_get_irq(QTestState *s, int num)
|
|
{
|
|
/* dummy operation in order to make sure irq is up to date */
|
|
qtest_inb(s, 0);
|
|
|
|
return s->irq_level[num];
|
|
}
|
|
|
|
static int64_t qtest_clock_rsp(QTestState *s)
|
|
{
|
|
gchar **words;
|
|
int64_t clock;
|
|
words = qtest_rsp(s, 2);
|
|
clock = g_ascii_strtoll(words[1], NULL, 0);
|
|
g_strfreev(words);
|
|
return clock;
|
|
}
|
|
|
|
int64_t qtest_clock_step_next(QTestState *s)
|
|
{
|
|
qtest_sendf(s, "clock_step\n");
|
|
return qtest_clock_rsp(s);
|
|
}
|
|
|
|
int64_t qtest_clock_step(QTestState *s, int64_t step)
|
|
{
|
|
qtest_sendf(s, "clock_step %"PRIi64"\n", step);
|
|
return qtest_clock_rsp(s);
|
|
}
|
|
|
|
int64_t qtest_clock_set(QTestState *s, int64_t val)
|
|
{
|
|
qtest_sendf(s, "clock_set %"PRIi64"\n", val);
|
|
return qtest_clock_rsp(s);
|
|
}
|
|
|
|
void qtest_irq_intercept_out(QTestState *s, const char *qom_path)
|
|
{
|
|
qtest_sendf(s, "irq_intercept_out %s\n", qom_path);
|
|
qtest_rsp(s, 0);
|
|
}
|
|
|
|
void qtest_irq_intercept_in(QTestState *s, const char *qom_path)
|
|
{
|
|
qtest_sendf(s, "irq_intercept_in %s\n", qom_path);
|
|
qtest_rsp(s, 0);
|
|
}
|
|
|
|
static void qtest_out(QTestState *s, const char *cmd, uint16_t addr, uint32_t value)
|
|
{
|
|
qtest_sendf(s, "%s 0x%x 0x%x\n", cmd, addr, value);
|
|
qtest_rsp(s, 0);
|
|
}
|
|
|
|
void qtest_outb(QTestState *s, uint16_t addr, uint8_t value)
|
|
{
|
|
qtest_out(s, "outb", addr, value);
|
|
}
|
|
|
|
void qtest_outw(QTestState *s, uint16_t addr, uint16_t value)
|
|
{
|
|
qtest_out(s, "outw", addr, value);
|
|
}
|
|
|
|
void qtest_outl(QTestState *s, uint16_t addr, uint32_t value)
|
|
{
|
|
qtest_out(s, "outl", addr, value);
|
|
}
|
|
|
|
static uint32_t qtest_in(QTestState *s, const char *cmd, uint16_t addr)
|
|
{
|
|
gchar **args;
|
|
uint32_t value;
|
|
|
|
qtest_sendf(s, "%s 0x%x\n", cmd, addr);
|
|
args = qtest_rsp(s, 2);
|
|
value = strtoul(args[1], NULL, 0);
|
|
g_strfreev(args);
|
|
|
|
return value;
|
|
}
|
|
|
|
uint8_t qtest_inb(QTestState *s, uint16_t addr)
|
|
{
|
|
return qtest_in(s, "inb", addr);
|
|
}
|
|
|
|
uint16_t qtest_inw(QTestState *s, uint16_t addr)
|
|
{
|
|
return qtest_in(s, "inw", addr);
|
|
}
|
|
|
|
uint32_t qtest_inl(QTestState *s, uint16_t addr)
|
|
{
|
|
return qtest_in(s, "inl", addr);
|
|
}
|
|
|
|
static void qtest_write(QTestState *s, const char *cmd, uint64_t addr,
|
|
uint64_t value)
|
|
{
|
|
qtest_sendf(s, "%s 0x%" PRIx64 " 0x%" PRIx64 "\n", cmd, addr, value);
|
|
qtest_rsp(s, 0);
|
|
}
|
|
|
|
void qtest_writeb(QTestState *s, uint64_t addr, uint8_t value)
|
|
{
|
|
qtest_write(s, "writeb", addr, value);
|
|
}
|
|
|
|
void qtest_writew(QTestState *s, uint64_t addr, uint16_t value)
|
|
{
|
|
qtest_write(s, "writew", addr, value);
|
|
}
|
|
|
|
void qtest_writel(QTestState *s, uint64_t addr, uint32_t value)
|
|
{
|
|
qtest_write(s, "writel", addr, value);
|
|
}
|
|
|
|
void qtest_writeq(QTestState *s, uint64_t addr, uint64_t value)
|
|
{
|
|
qtest_write(s, "writeq", addr, value);
|
|
}
|
|
|
|
static uint64_t qtest_read(QTestState *s, const char *cmd, uint64_t addr)
|
|
{
|
|
gchar **args;
|
|
uint64_t value;
|
|
|
|
qtest_sendf(s, "%s 0x%" PRIx64 "\n", cmd, addr);
|
|
args = qtest_rsp(s, 2);
|
|
value = strtoull(args[1], NULL, 0);
|
|
g_strfreev(args);
|
|
|
|
return value;
|
|
}
|
|
|
|
uint8_t qtest_readb(QTestState *s, uint64_t addr)
|
|
{
|
|
return qtest_read(s, "readb", addr);
|
|
}
|
|
|
|
uint16_t qtest_readw(QTestState *s, uint64_t addr)
|
|
{
|
|
return qtest_read(s, "readw", addr);
|
|
}
|
|
|
|
uint32_t qtest_readl(QTestState *s, uint64_t addr)
|
|
{
|
|
return qtest_read(s, "readl", addr);
|
|
}
|
|
|
|
uint64_t qtest_readq(QTestState *s, uint64_t addr)
|
|
{
|
|
return qtest_read(s, "readq", addr);
|
|
}
|
|
|
|
static int hex2nib(char ch)
|
|
{
|
|
if (ch >= '0' && ch <= '9') {
|
|
return ch - '0';
|
|
} else if (ch >= 'a' && ch <= 'f') {
|
|
return 10 + (ch - 'a');
|
|
} else if (ch >= 'A' && ch <= 'F') {
|
|
return 10 + (ch - 'a');
|
|
} else {
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
void qtest_memread(QTestState *s, uint64_t addr, void *data, size_t size)
|
|
{
|
|
uint8_t *ptr = data;
|
|
gchar **args;
|
|
size_t i;
|
|
|
|
qtest_sendf(s, "read 0x%" PRIx64 " 0x%zx\n", addr, size);
|
|
args = qtest_rsp(s, 2);
|
|
|
|
for (i = 0; i < size; i++) {
|
|
ptr[i] = hex2nib(args[1][2 + (i * 2)]) << 4;
|
|
ptr[i] |= hex2nib(args[1][2 + (i * 2) + 1]);
|
|
}
|
|
|
|
g_strfreev(args);
|
|
}
|
|
|
|
void qtest_add_func(const char *str, void (*fn))
|
|
{
|
|
gchar *path = g_strdup_printf("/%s/%s", qtest_get_arch(), str);
|
|
g_test_add_func(path, fn);
|
|
}
|
|
|
|
void qtest_memwrite(QTestState *s, uint64_t addr, const void *data, size_t size)
|
|
{
|
|
const uint8_t *ptr = data;
|
|
size_t i;
|
|
|
|
qtest_sendf(s, "write 0x%" PRIx64 " 0x%zx 0x", addr, size);
|
|
for (i = 0; i < size; i++) {
|
|
qtest_sendf(s, "%02x", ptr[i]);
|
|
}
|
|
qtest_sendf(s, "\n");
|
|
qtest_rsp(s, 0);
|
|
}
|