22f2e34474
snprintf returns number of bytes needed for the output, not the number of bytes actually written. Thus the math is wrong ... Spotted by Markus Armbruster. Signed-off-by: Gerd Hoffmann <kraxel@redhat.com> Signed-off-by: Anthony Liguori <aliguori@us.ibm.com> Message-Id:
610 lines
17 KiB
C
610 lines
17 KiB
C
/*
|
|
* Dynamic device configuration and creation.
|
|
*
|
|
* Copyright (c) 2009 CodeSourcery
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2 of the License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
* License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
/* The theory here is that it should be possible to create a machine without
|
|
knowledge of specific devices. Historically board init routines have
|
|
passed a bunch of arguments to each device, requiring the board know
|
|
exactly which device it is dealing with. This file provides an abstract
|
|
API for device configuration and initialization. Devices will generally
|
|
inherit from a particular bus (e.g. PCI or I2C) rather than
|
|
this API directly. */
|
|
|
|
#include "net.h"
|
|
#include "qdev.h"
|
|
#include "sysemu.h"
|
|
#include "monitor.h"
|
|
|
|
/* This is a nasty hack to allow passing a NULL bus to qdev_create. */
|
|
static BusState *main_system_bus;
|
|
|
|
static DeviceInfo *device_info_list;
|
|
|
|
static BusState *qbus_find_recursive(BusState *bus, const char *name,
|
|
const BusInfo *info);
|
|
static BusState *qbus_find(const char *path);
|
|
|
|
/* Register a new device type. */
|
|
void qdev_register(DeviceInfo *info)
|
|
{
|
|
assert(info->size >= sizeof(DeviceState));
|
|
assert(!info->next);
|
|
|
|
info->next = device_info_list;
|
|
device_info_list = info;
|
|
}
|
|
|
|
static DeviceInfo *qdev_find_info(BusInfo *bus_info, const char *name)
|
|
{
|
|
DeviceInfo *info;
|
|
|
|
/* first check device names */
|
|
for (info = device_info_list; info != NULL; info = info->next) {
|
|
if (bus_info && info->bus_info != bus_info)
|
|
continue;
|
|
if (strcmp(info->name, name) != 0)
|
|
continue;
|
|
return info;
|
|
}
|
|
|
|
/* failing that check the aliases */
|
|
for (info = device_info_list; info != NULL; info = info->next) {
|
|
if (bus_info && info->bus_info != bus_info)
|
|
continue;
|
|
if (!info->alias)
|
|
continue;
|
|
if (strcmp(info->alias, name) != 0)
|
|
continue;
|
|
return info;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
/* Create a new device. This only initializes the device state structure
|
|
and allows properties to be set. qdev_init should be called to
|
|
initialize the actual device emulation. */
|
|
DeviceState *qdev_create(BusState *bus, const char *name)
|
|
{
|
|
DeviceInfo *info;
|
|
DeviceState *dev;
|
|
|
|
if (!bus) {
|
|
if (!main_system_bus) {
|
|
main_system_bus = qbus_create(&system_bus_info, NULL, "main-system-bus");
|
|
}
|
|
bus = main_system_bus;
|
|
}
|
|
|
|
info = qdev_find_info(bus->info, name);
|
|
if (!info) {
|
|
hw_error("Unknown device '%s' for bus '%s'\n", name, bus->info->name);
|
|
}
|
|
|
|
dev = qemu_mallocz(info->size);
|
|
dev->info = info;
|
|
dev->parent_bus = bus;
|
|
qdev_prop_set_defaults(dev, dev->info->props);
|
|
qdev_prop_set_defaults(dev, dev->parent_bus->info->props);
|
|
qdev_prop_set_compat(dev);
|
|
LIST_INSERT_HEAD(&bus->children, dev, sibling);
|
|
return dev;
|
|
}
|
|
|
|
static int qdev_print_devinfo(DeviceInfo *info, char *dest, int len)
|
|
{
|
|
int pos = 0;
|
|
int ret;
|
|
|
|
ret = snprintf(dest+pos, len-pos, "name \"%s\", bus %s",
|
|
info->name, info->bus_info->name);
|
|
pos += MIN(len-pos,ret);
|
|
if (info->alias) {
|
|
ret = snprintf(dest+pos, len-pos, ", alias \"%s\"", info->alias);
|
|
pos += MIN(len-pos,ret);
|
|
}
|
|
if (info->desc) {
|
|
ret = snprintf(dest+pos, len-pos, ", desc \"%s\"", info->desc);
|
|
pos += MIN(len-pos,ret);
|
|
}
|
|
if (info->no_user) {
|
|
ret = snprintf(dest+pos, len-pos, ", no-user");
|
|
pos += MIN(len-pos,ret);
|
|
}
|
|
return pos;
|
|
}
|
|
|
|
static int set_property(const char *name, const char *value, void *opaque)
|
|
{
|
|
DeviceState *dev = opaque;
|
|
|
|
if (strcmp(name, "driver") == 0)
|
|
return 0;
|
|
if (strcmp(name, "bus") == 0)
|
|
return 0;
|
|
|
|
if (-1 == qdev_prop_parse(dev, name, value)) {
|
|
fprintf(stderr, "can't set property \"%s\" to \"%s\" for \"%s\"\n",
|
|
name, value, dev->info->name);
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
DeviceState *qdev_device_add(QemuOpts *opts)
|
|
{
|
|
const char *driver, *path, *id;
|
|
DeviceInfo *info;
|
|
DeviceState *qdev;
|
|
BusState *bus;
|
|
|
|
driver = qemu_opt_get(opts, "driver");
|
|
if (!driver) {
|
|
fprintf(stderr, "-device: no driver specified\n");
|
|
return NULL;
|
|
}
|
|
if (strcmp(driver, "?") == 0) {
|
|
char msg[256];
|
|
for (info = device_info_list; info != NULL; info = info->next) {
|
|
qdev_print_devinfo(info, msg, sizeof(msg));
|
|
fprintf(stderr, "%s\n", msg);
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
/* find driver */
|
|
info = qdev_find_info(NULL, driver);
|
|
if (!info) {
|
|
fprintf(stderr, "Device \"%s\" not found. Try -device '?' for a list.\n",
|
|
driver);
|
|
return NULL;
|
|
}
|
|
if (info->no_user) {
|
|
fprintf(stderr, "device \"%s\" can't be added via command line\n",
|
|
info->name);
|
|
return NULL;
|
|
}
|
|
|
|
/* find bus */
|
|
path = qemu_opt_get(opts, "bus");
|
|
if (path != NULL) {
|
|
bus = qbus_find(path);
|
|
} else {
|
|
bus = qbus_find_recursive(main_system_bus, NULL, info->bus_info);
|
|
}
|
|
if (!bus)
|
|
return NULL;
|
|
|
|
/* create device, set properties */
|
|
qdev = qdev_create(bus, driver);
|
|
id = qemu_opts_id(opts);
|
|
if (id) {
|
|
qdev->id = id;
|
|
}
|
|
if (qemu_opt_foreach(opts, set_property, qdev, 1) != 0) {
|
|
qdev_free(qdev);
|
|
return NULL;
|
|
}
|
|
qdev_init(qdev);
|
|
return qdev;
|
|
}
|
|
|
|
/* Initialize a device. Device properties should be set before calling
|
|
this function. IRQs and MMIO regions should be connected/mapped after
|
|
calling this function. */
|
|
void qdev_init(DeviceState *dev)
|
|
{
|
|
dev->info->init(dev, dev->info);
|
|
}
|
|
|
|
/* Unlink device from bus and free the structure. */
|
|
void qdev_free(DeviceState *dev)
|
|
{
|
|
LIST_REMOVE(dev, sibling);
|
|
qemu_free(dev);
|
|
}
|
|
|
|
/* Get a character (serial) device interface. */
|
|
CharDriverState *qdev_init_chardev(DeviceState *dev)
|
|
{
|
|
static int next_serial;
|
|
static int next_virtconsole;
|
|
/* FIXME: This is a nasty hack that needs to go away. */
|
|
if (strncmp(dev->info->name, "virtio", 6) == 0) {
|
|
return virtcon_hds[next_virtconsole++];
|
|
} else {
|
|
return serial_hds[next_serial++];
|
|
}
|
|
}
|
|
|
|
BusState *qdev_get_parent_bus(DeviceState *dev)
|
|
{
|
|
return dev->parent_bus;
|
|
}
|
|
|
|
void qdev_init_gpio_in(DeviceState *dev, qemu_irq_handler handler, int n)
|
|
{
|
|
assert(dev->num_gpio_in == 0);
|
|
dev->num_gpio_in = n;
|
|
dev->gpio_in = qemu_allocate_irqs(handler, dev, n);
|
|
}
|
|
|
|
void qdev_init_gpio_out(DeviceState *dev, qemu_irq *pins, int n)
|
|
{
|
|
assert(dev->num_gpio_out == 0);
|
|
dev->num_gpio_out = n;
|
|
dev->gpio_out = pins;
|
|
}
|
|
|
|
qemu_irq qdev_get_gpio_in(DeviceState *dev, int n)
|
|
{
|
|
assert(n >= 0 && n < dev->num_gpio_in);
|
|
return dev->gpio_in[n];
|
|
}
|
|
|
|
void qdev_connect_gpio_out(DeviceState * dev, int n, qemu_irq pin)
|
|
{
|
|
assert(n >= 0 && n < dev->num_gpio_out);
|
|
dev->gpio_out[n] = pin;
|
|
}
|
|
|
|
VLANClientState *qdev_get_vlan_client(DeviceState *dev,
|
|
NetCanReceive *can_receive,
|
|
NetReceive *receive,
|
|
NetReceiveIOV *receive_iov,
|
|
NetCleanup *cleanup,
|
|
void *opaque)
|
|
{
|
|
NICInfo *nd = dev->nd;
|
|
assert(nd);
|
|
nd->vc = qemu_new_vlan_client(nd->vlan, nd->model, nd->name, can_receive,
|
|
receive, receive_iov, cleanup, opaque);
|
|
return nd->vc;
|
|
}
|
|
|
|
|
|
void qdev_get_macaddr(DeviceState *dev, uint8_t *macaddr)
|
|
{
|
|
memcpy(macaddr, dev->nd->macaddr, 6);
|
|
}
|
|
|
|
static int next_block_unit[IF_COUNT];
|
|
|
|
/* Get a block device. This should only be used for single-drive devices
|
|
(e.g. SD/Floppy/MTD). Multi-disk devices (scsi/ide) should use the
|
|
appropriate bus. */
|
|
BlockDriverState *qdev_init_bdrv(DeviceState *dev, BlockInterfaceType type)
|
|
{
|
|
int unit = next_block_unit[type]++;
|
|
DriveInfo *dinfo;
|
|
|
|
dinfo = drive_get(type, 0, unit);
|
|
return dinfo ? dinfo->bdrv : NULL;
|
|
}
|
|
|
|
BusState *qdev_get_child_bus(DeviceState *dev, const char *name)
|
|
{
|
|
BusState *bus;
|
|
|
|
LIST_FOREACH(bus, &dev->child_bus, sibling) {
|
|
if (strcmp(name, bus->name) == 0) {
|
|
return bus;
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static int next_scsi_bus;
|
|
|
|
/* Create a scsi bus, and attach devices to it. */
|
|
/* TODO: Actually create a scsi bus for hotplug to use. */
|
|
void scsi_bus_new(DeviceState *host, SCSIAttachFn attach)
|
|
{
|
|
int bus = next_scsi_bus++;
|
|
int unit;
|
|
DriveInfo *dinfo;
|
|
|
|
for (unit = 0; unit < MAX_SCSI_DEVS; unit++) {
|
|
dinfo = drive_get(IF_SCSI, bus, unit);
|
|
if (!dinfo) {
|
|
continue;
|
|
}
|
|
attach(host, dinfo->bdrv, unit);
|
|
}
|
|
}
|
|
|
|
static BusState *qbus_find_recursive(BusState *bus, const char *name,
|
|
const BusInfo *info)
|
|
{
|
|
DeviceState *dev;
|
|
BusState *child, *ret;
|
|
int match = 1;
|
|
|
|
if (name && (strcmp(bus->name, name) != 0)) {
|
|
match = 0;
|
|
}
|
|
if (info && (bus->info != info)) {
|
|
match = 0;
|
|
}
|
|
if (match) {
|
|
return bus;
|
|
}
|
|
|
|
LIST_FOREACH(dev, &bus->children, sibling) {
|
|
LIST_FOREACH(child, &dev->child_bus, sibling) {
|
|
ret = qbus_find_recursive(child, name, info);
|
|
if (ret) {
|
|
return ret;
|
|
}
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static void qbus_list_bus(DeviceState *dev, char *dest, int len)
|
|
{
|
|
BusState *child;
|
|
const char *sep = " ";
|
|
int pos = 0;
|
|
|
|
pos += snprintf(dest+pos, len-pos,"child busses at \"%s\":",
|
|
dev->id ? dev->id : dev->info->name);
|
|
LIST_FOREACH(child, &dev->child_bus, sibling) {
|
|
pos += snprintf(dest+pos, len-pos, "%s\"%s\"", sep, child->name);
|
|
sep = ", ";
|
|
}
|
|
}
|
|
|
|
static void qbus_list_dev(BusState *bus, char *dest, int len)
|
|
{
|
|
DeviceState *dev;
|
|
const char *sep = " ";
|
|
int pos = 0;
|
|
|
|
pos += snprintf(dest+pos, len-pos, "devices at \"%s\":",
|
|
bus->name);
|
|
LIST_FOREACH(dev, &bus->children, sibling) {
|
|
pos += snprintf(dest+pos, len-pos, "%s\"%s\"",
|
|
sep, dev->info->name);
|
|
if (dev->id)
|
|
pos += snprintf(dest+pos, len-pos, "/\"%s\"", dev->id);
|
|
sep = ", ";
|
|
}
|
|
}
|
|
|
|
static BusState *qbus_find_bus(DeviceState *dev, char *elem)
|
|
{
|
|
BusState *child;
|
|
|
|
LIST_FOREACH(child, &dev->child_bus, sibling) {
|
|
if (strcmp(child->name, elem) == 0) {
|
|
return child;
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static DeviceState *qbus_find_dev(BusState *bus, char *elem)
|
|
{
|
|
DeviceState *dev;
|
|
|
|
/*
|
|
* try to match in order:
|
|
* (1) instance id, if present
|
|
* (2) driver name
|
|
* (3) driver alias, if present
|
|
*/
|
|
LIST_FOREACH(dev, &bus->children, sibling) {
|
|
if (dev->id && strcmp(dev->id, elem) == 0) {
|
|
return dev;
|
|
}
|
|
}
|
|
LIST_FOREACH(dev, &bus->children, sibling) {
|
|
if (strcmp(dev->info->name, elem) == 0) {
|
|
return dev;
|
|
}
|
|
}
|
|
LIST_FOREACH(dev, &bus->children, sibling) {
|
|
if (dev->info->alias && strcmp(dev->info->alias, elem) == 0) {
|
|
return dev;
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static BusState *qbus_find(const char *path)
|
|
{
|
|
DeviceState *dev;
|
|
BusState *bus;
|
|
char elem[128], msg[256];
|
|
int pos, len;
|
|
|
|
/* find start element */
|
|
if (path[0] == '/') {
|
|
bus = main_system_bus;
|
|
pos = 0;
|
|
} else {
|
|
if (sscanf(path, "%127[^/]%n", elem, &len) != 1) {
|
|
fprintf(stderr, "path parse error (\"%s\")\n", path);
|
|
return NULL;
|
|
}
|
|
bus = qbus_find_recursive(main_system_bus, elem, NULL);
|
|
if (!bus) {
|
|
fprintf(stderr, "bus \"%s\" not found\n", elem);
|
|
return NULL;
|
|
}
|
|
pos = len;
|
|
}
|
|
|
|
for (;;) {
|
|
if (path[pos] == '\0') {
|
|
/* we are done */
|
|
return bus;
|
|
}
|
|
|
|
/* find device */
|
|
if (sscanf(path+pos, "/%127[^/]%n", elem, &len) != 1) {
|
|
fprintf(stderr, "path parse error (\"%s\" pos %d)\n", path, pos);
|
|
return NULL;
|
|
}
|
|
pos += len;
|
|
dev = qbus_find_dev(bus, elem);
|
|
if (!dev) {
|
|
qbus_list_dev(bus, msg, sizeof(msg));
|
|
fprintf(stderr, "device \"%s\" not found\n%s\n", elem, msg);
|
|
return NULL;
|
|
}
|
|
if (path[pos] == '\0') {
|
|
/* last specified element is a device. If it has exactly
|
|
* one child bus accept it nevertheless */
|
|
switch (dev->num_child_bus) {
|
|
case 0:
|
|
fprintf(stderr, "device has no child bus (%s)\n", path);
|
|
return NULL;
|
|
case 1:
|
|
return LIST_FIRST(&dev->child_bus);
|
|
default:
|
|
qbus_list_bus(dev, msg, sizeof(msg));
|
|
fprintf(stderr, "device has multiple child busses (%s)\n%s\n",
|
|
path, msg);
|
|
return NULL;
|
|
}
|
|
}
|
|
|
|
/* find bus */
|
|
if (sscanf(path+pos, "/%127[^/]%n", elem, &len) != 1) {
|
|
fprintf(stderr, "path parse error (\"%s\" pos %d)\n", path, pos);
|
|
return NULL;
|
|
}
|
|
pos += len;
|
|
bus = qbus_find_bus(dev, elem);
|
|
if (!bus) {
|
|
qbus_list_bus(dev, msg, sizeof(msg));
|
|
fprintf(stderr, "child bus \"%s\" not found\n%s\n", elem, msg);
|
|
return NULL;
|
|
}
|
|
}
|
|
}
|
|
|
|
BusState *qbus_create(BusInfo *info, DeviceState *parent, const char *name)
|
|
{
|
|
BusState *bus;
|
|
char *buf;
|
|
int i,len;
|
|
|
|
bus = qemu_mallocz(info->size);
|
|
bus->info = info;
|
|
bus->parent = parent;
|
|
|
|
if (name) {
|
|
/* use supplied name */
|
|
bus->name = qemu_strdup(name);
|
|
} else if (parent && parent->id) {
|
|
/* parent device has id -> use it for bus name */
|
|
len = strlen(parent->id) + 16;
|
|
buf = qemu_malloc(len);
|
|
snprintf(buf, len, "%s.%d", parent->id, parent->num_child_bus);
|
|
bus->name = buf;
|
|
} else {
|
|
/* no id -> use lowercase bus type for bus name */
|
|
len = strlen(info->name) + 16;
|
|
buf = qemu_malloc(len);
|
|
len = snprintf(buf, len, "%s.%d", info->name,
|
|
parent ? parent->num_child_bus : 0);
|
|
for (i = 0; i < len; i++)
|
|
buf[i] = qemu_tolower(buf[i]);
|
|
bus->name = buf;
|
|
}
|
|
|
|
LIST_INIT(&bus->children);
|
|
if (parent) {
|
|
LIST_INSERT_HEAD(&parent->child_bus, bus, sibling);
|
|
parent->num_child_bus++;
|
|
}
|
|
return bus;
|
|
}
|
|
|
|
#define qdev_printf(fmt, ...) monitor_printf(mon, "%*s" fmt, indent, "", ## __VA_ARGS__)
|
|
static void qbus_print(Monitor *mon, BusState *bus, int indent);
|
|
|
|
static void qdev_print_props(Monitor *mon, DeviceState *dev, Property *props,
|
|
const char *prefix, int indent)
|
|
{
|
|
char buf[64];
|
|
|
|
if (!props)
|
|
return;
|
|
while (props->name) {
|
|
if (props->info->print) {
|
|
props->info->print(dev, props, buf, sizeof(buf));
|
|
qdev_printf("%s-prop: %s = %s\n", prefix, props->name, buf);
|
|
}
|
|
props++;
|
|
}
|
|
}
|
|
|
|
static void qdev_print(Monitor *mon, DeviceState *dev, int indent)
|
|
{
|
|
BusState *child;
|
|
qdev_printf("dev: %s, id \"%s\"\n", dev->info->name,
|
|
dev->id ? dev->id : "");
|
|
indent += 2;
|
|
if (dev->num_gpio_in) {
|
|
qdev_printf("gpio-in %d\n", dev->num_gpio_in);
|
|
}
|
|
if (dev->num_gpio_out) {
|
|
qdev_printf("gpio-out %d\n", dev->num_gpio_out);
|
|
}
|
|
qdev_print_props(mon, dev, dev->info->props, "dev", indent);
|
|
qdev_print_props(mon, dev, dev->parent_bus->info->props, "bus", indent);
|
|
if (dev->parent_bus->info->print_dev)
|
|
dev->parent_bus->info->print_dev(mon, dev, indent);
|
|
LIST_FOREACH(child, &dev->child_bus, sibling) {
|
|
qbus_print(mon, child, indent);
|
|
}
|
|
}
|
|
|
|
static void qbus_print(Monitor *mon, BusState *bus, int indent)
|
|
{
|
|
struct DeviceState *dev;
|
|
|
|
qdev_printf("bus: %s\n", bus->name);
|
|
indent += 2;
|
|
qdev_printf("type %s\n", bus->info->name);
|
|
LIST_FOREACH(dev, &bus->children, sibling) {
|
|
qdev_print(mon, dev, indent);
|
|
}
|
|
}
|
|
#undef qdev_printf
|
|
|
|
void do_info_qtree(Monitor *mon)
|
|
{
|
|
if (main_system_bus)
|
|
qbus_print(mon, main_system_bus, 0);
|
|
}
|
|
|
|
void do_info_qdrv(Monitor *mon)
|
|
{
|
|
DeviceInfo *info;
|
|
char msg[256];
|
|
|
|
for (info = device_info_list; info != NULL; info = info->next) {
|
|
qdev_print_devinfo(info, msg, sizeof(msg));
|
|
monitor_printf(mon, "%s\n", msg);
|
|
}
|
|
}
|