12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376 |
- /*
- * Copyright (c) 2018 Citrix Systems Inc.
- *
- * 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 "qemu/osdep.h"
- #include "qemu/main-loop.h"
- #include "qemu/module.h"
- #include "qemu/uuid.h"
- #include "hw/qdev-properties.h"
- #include "hw/sysbus.h"
- #include "hw/xen/xen.h"
- #include "hw/xen/xen-backend.h"
- #include "hw/xen/xen-bus.h"
- #include "hw/xen/xen-bus-helper.h"
- #include "monitor/monitor.h"
- #include "qapi/error.h"
- #include "qapi/qmp/qdict.h"
- #include "sysemu/sysemu.h"
- #include "trace.h"
- static char *xen_device_get_backend_path(XenDevice *xendev)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- XenDeviceClass *xendev_class = XEN_DEVICE_GET_CLASS(xendev);
- const char *type = object_get_typename(OBJECT(xendev));
- const char *backend = xendev_class->backend;
- if (!backend) {
- backend = type;
- }
- return g_strdup_printf("/local/domain/%u/backend/%s/%u/%s",
- xenbus->backend_id, backend, xendev->frontend_id,
- xendev->name);
- }
- static char *xen_device_get_frontend_path(XenDevice *xendev)
- {
- XenDeviceClass *xendev_class = XEN_DEVICE_GET_CLASS(xendev);
- const char *type = object_get_typename(OBJECT(xendev));
- const char *device = xendev_class->device;
- if (!device) {
- device = type;
- }
- return g_strdup_printf("/local/domain/%u/device/%s/%s",
- xendev->frontend_id, device, xendev->name);
- }
- static void xen_device_unplug(XenDevice *xendev, Error **errp)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- const char *type = object_get_typename(OBJECT(xendev));
- Error *local_err = NULL;
- xs_transaction_t tid;
- trace_xen_device_unplug(type, xendev->name);
- /* Mimic the way the Xen toolstack does an unplug */
- again:
- tid = xs_transaction_start(xenbus->xsh);
- if (tid == XBT_NULL) {
- error_setg_errno(errp, errno, "failed xs_transaction_start");
- return;
- }
- xs_node_printf(xenbus->xsh, tid, xendev->backend_path, "online",
- &local_err, "%u", 0);
- if (local_err) {
- goto abort;
- }
- xs_node_printf(xenbus->xsh, tid, xendev->backend_path, "state",
- &local_err, "%u", XenbusStateClosing);
- if (local_err) {
- goto abort;
- }
- if (!xs_transaction_end(xenbus->xsh, tid, false)) {
- if (errno == EAGAIN) {
- goto again;
- }
- error_setg_errno(errp, errno, "failed xs_transaction_end");
- }
- return;
- abort:
- /*
- * We only abort if there is already a failure so ignore any error
- * from ending the transaction.
- */
- xs_transaction_end(xenbus->xsh, tid, true);
- error_propagate(errp, local_err);
- }
- static void xen_bus_print_dev(Monitor *mon, DeviceState *dev, int indent)
- {
- XenDevice *xendev = XEN_DEVICE(dev);
- monitor_printf(mon, "%*sname = '%s' frontend_id = %u\n",
- indent, "", xendev->name, xendev->frontend_id);
- }
- static char *xen_bus_get_dev_path(DeviceState *dev)
- {
- return xen_device_get_backend_path(XEN_DEVICE(dev));
- }
- struct XenWatch {
- char *node, *key;
- char *token;
- XenWatchHandler handler;
- void *opaque;
- Notifier notifier;
- };
- static void watch_notify(Notifier *n, void *data)
- {
- XenWatch *watch = container_of(n, XenWatch, notifier);
- const char *token = data;
- if (!strcmp(watch->token, token)) {
- watch->handler(watch->opaque);
- }
- }
- static XenWatch *new_watch(const char *node, const char *key,
- XenWatchHandler handler, void *opaque)
- {
- XenWatch *watch = g_new0(XenWatch, 1);
- QemuUUID uuid;
- qemu_uuid_generate(&uuid);
- watch->token = qemu_uuid_unparse_strdup(&uuid);
- watch->node = g_strdup(node);
- watch->key = g_strdup(key);
- watch->handler = handler;
- watch->opaque = opaque;
- watch->notifier.notify = watch_notify;
- return watch;
- }
- static void free_watch(XenWatch *watch)
- {
- g_free(watch->token);
- g_free(watch->key);
- g_free(watch->node);
- g_free(watch);
- }
- struct XenWatchList {
- struct xs_handle *xsh;
- NotifierList notifiers;
- };
- static void watch_list_event(void *opaque)
- {
- XenWatchList *watch_list = opaque;
- char **v;
- const char *token;
- v = xs_check_watch(watch_list->xsh);
- if (!v) {
- return;
- }
- token = v[XS_WATCH_TOKEN];
- notifier_list_notify(&watch_list->notifiers, (void *)token);
- free(v);
- }
- static XenWatchList *watch_list_create(struct xs_handle *xsh)
- {
- XenWatchList *watch_list = g_new0(XenWatchList, 1);
- g_assert(xsh);
- watch_list->xsh = xsh;
- notifier_list_init(&watch_list->notifiers);
- qemu_set_fd_handler(xs_fileno(watch_list->xsh), watch_list_event, NULL,
- watch_list);
- return watch_list;
- }
- static void watch_list_destroy(XenWatchList *watch_list)
- {
- g_assert(notifier_list_empty(&watch_list->notifiers));
- qemu_set_fd_handler(xs_fileno(watch_list->xsh), NULL, NULL, NULL);
- g_free(watch_list);
- }
- static XenWatch *watch_list_add(XenWatchList *watch_list, const char *node,
- const char *key, XenWatchHandler handler,
- void *opaque, Error **errp)
- {
- XenWatch *watch = new_watch(node, key, handler, opaque);
- Error *local_err = NULL;
- notifier_list_add(&watch_list->notifiers, &watch->notifier);
- xs_node_watch(watch_list->xsh, node, key, watch->token, &local_err);
- if (local_err) {
- error_propagate(errp, local_err);
- notifier_remove(&watch->notifier);
- free_watch(watch);
- return NULL;
- }
- return watch;
- }
- static void watch_list_remove(XenWatchList *watch_list, XenWatch *watch,
- Error **errp)
- {
- xs_node_unwatch(watch_list->xsh, watch->node, watch->key, watch->token,
- errp);
- notifier_remove(&watch->notifier);
- free_watch(watch);
- }
- static XenWatch *xen_bus_add_watch(XenBus *xenbus, const char *node,
- const char *key, XenWatchHandler handler,
- Error **errp)
- {
- trace_xen_bus_add_watch(node, key);
- return watch_list_add(xenbus->watch_list, node, key, handler, xenbus,
- errp);
- }
- static void xen_bus_remove_watch(XenBus *xenbus, XenWatch *watch,
- Error **errp)
- {
- trace_xen_bus_remove_watch(watch->node, watch->key);
- watch_list_remove(xenbus->watch_list, watch, errp);
- }
- static void xen_bus_backend_create(XenBus *xenbus, const char *type,
- const char *name, char *path,
- Error **errp)
- {
- xs_transaction_t tid;
- char **key;
- QDict *opts;
- unsigned int i, n;
- Error *local_err = NULL;
- trace_xen_bus_backend_create(type, path);
- again:
- tid = xs_transaction_start(xenbus->xsh);
- if (tid == XBT_NULL) {
- error_setg(errp, "failed xs_transaction_start");
- return;
- }
- key = xs_directory(xenbus->xsh, tid, path, &n);
- if (!key) {
- if (!xs_transaction_end(xenbus->xsh, tid, true)) {
- error_setg_errno(errp, errno, "failed xs_transaction_end");
- }
- return;
- }
- opts = qdict_new();
- for (i = 0; i < n; i++) {
- char *val;
- /*
- * Assume anything found in the xenstore backend area, other than
- * the keys created for a generic XenDevice, are parameters
- * to be used to configure the backend.
- */
- if (!strcmp(key[i], "state") ||
- !strcmp(key[i], "online") ||
- !strcmp(key[i], "frontend") ||
- !strcmp(key[i], "frontend-id") ||
- !strcmp(key[i], "hotplug-status"))
- continue;
- if (xs_node_scanf(xenbus->xsh, tid, path, key[i], NULL, "%ms",
- &val) == 1) {
- qdict_put_str(opts, key[i], val);
- free(val);
- }
- }
- free(key);
- if (!xs_transaction_end(xenbus->xsh, tid, false)) {
- qobject_unref(opts);
- if (errno == EAGAIN) {
- goto again;
- }
- error_setg_errno(errp, errno, "failed xs_transaction_end");
- return;
- }
- xen_backend_device_create(xenbus, type, name, opts, &local_err);
- qobject_unref(opts);
- if (local_err) {
- error_propagate_prepend(errp, local_err,
- "failed to create '%s' device '%s': ",
- type, name);
- }
- }
- static void xen_bus_type_enumerate(XenBus *xenbus, const char *type)
- {
- char *domain_path = g_strdup_printf("backend/%s/%u", type, xen_domid);
- char **backend;
- unsigned int i, n;
- trace_xen_bus_type_enumerate(type);
- backend = xs_directory(xenbus->xsh, XBT_NULL, domain_path, &n);
- if (!backend) {
- goto out;
- }
- for (i = 0; i < n; i++) {
- char *backend_path = g_strdup_printf("%s/%s", domain_path,
- backend[i]);
- enum xenbus_state state;
- unsigned int online;
- if (xs_node_scanf(xenbus->xsh, XBT_NULL, backend_path, "state",
- NULL, "%u", &state) != 1)
- state = XenbusStateUnknown;
- if (xs_node_scanf(xenbus->xsh, XBT_NULL, backend_path, "online",
- NULL, "%u", &online) != 1)
- online = 0;
- if (online && state == XenbusStateInitialising) {
- Error *local_err = NULL;
- xen_bus_backend_create(xenbus, type, backend[i], backend_path,
- &local_err);
- if (local_err) {
- error_report_err(local_err);
- }
- }
- g_free(backend_path);
- }
- free(backend);
- out:
- g_free(domain_path);
- }
- static void xen_bus_enumerate(XenBus *xenbus)
- {
- char **type;
- unsigned int i, n;
- trace_xen_bus_enumerate();
- type = xs_directory(xenbus->xsh, XBT_NULL, "backend", &n);
- if (!type) {
- return;
- }
- for (i = 0; i < n; i++) {
- xen_bus_type_enumerate(xenbus, type[i]);
- }
- free(type);
- }
- static void xen_bus_device_cleanup(XenDevice *xendev)
- {
- const char *type = object_get_typename(OBJECT(xendev));
- Error *local_err = NULL;
- trace_xen_bus_device_cleanup(type, xendev->name);
- g_assert(!xendev->backend_online);
- if (!xen_backend_try_device_destroy(xendev, &local_err)) {
- object_unparent(OBJECT(xendev));
- }
- if (local_err) {
- error_report_err(local_err);
- }
- }
- static void xen_bus_cleanup(XenBus *xenbus)
- {
- XenDevice *xendev, *next;
- trace_xen_bus_cleanup();
- QLIST_FOREACH_SAFE(xendev, &xenbus->inactive_devices, list, next) {
- g_assert(xendev->inactive);
- QLIST_REMOVE(xendev, list);
- xen_bus_device_cleanup(xendev);
- }
- }
- static void xen_bus_backend_changed(void *opaque)
- {
- XenBus *xenbus = opaque;
- xen_bus_enumerate(xenbus);
- xen_bus_cleanup(xenbus);
- }
- static void xen_bus_unrealize(BusState *bus, Error **errp)
- {
- XenBus *xenbus = XEN_BUS(bus);
- trace_xen_bus_unrealize();
- if (xenbus->backend_watch) {
- xen_bus_remove_watch(xenbus, xenbus->backend_watch, NULL);
- xenbus->backend_watch = NULL;
- }
- if (xenbus->watch_list) {
- watch_list_destroy(xenbus->watch_list);
- xenbus->watch_list = NULL;
- }
- if (xenbus->xsh) {
- xs_close(xenbus->xsh);
- }
- }
- static void xen_bus_realize(BusState *bus, Error **errp)
- {
- XenBus *xenbus = XEN_BUS(bus);
- unsigned int domid;
- Error *local_err = NULL;
- trace_xen_bus_realize();
- xenbus->xsh = xs_open(0);
- if (!xenbus->xsh) {
- error_setg_errno(errp, errno, "failed xs_open");
- goto fail;
- }
- if (xs_node_scanf(xenbus->xsh, XBT_NULL, "", /* domain root node */
- "domid", NULL, "%u", &domid) == 1) {
- xenbus->backend_id = domid;
- } else {
- xenbus->backend_id = 0; /* Assume lack of node means dom0 */
- }
- xenbus->watch_list = watch_list_create(xenbus->xsh);
- module_call_init(MODULE_INIT_XEN_BACKEND);
- xenbus->backend_watch =
- xen_bus_add_watch(xenbus, "", /* domain root node */
- "backend", xen_bus_backend_changed, &local_err);
- if (local_err) {
- /* This need not be treated as a hard error so don't propagate */
- error_reportf_err(local_err,
- "failed to set up enumeration watch: ");
- }
- return;
- fail:
- xen_bus_unrealize(bus, &error_abort);
- }
- static void xen_bus_unplug_request(HotplugHandler *hotplug,
- DeviceState *dev,
- Error **errp)
- {
- XenDevice *xendev = XEN_DEVICE(dev);
- xen_device_unplug(xendev, errp);
- }
- static void xen_bus_class_init(ObjectClass *class, void *data)
- {
- BusClass *bus_class = BUS_CLASS(class);
- HotplugHandlerClass *hotplug_class = HOTPLUG_HANDLER_CLASS(class);
- bus_class->print_dev = xen_bus_print_dev;
- bus_class->get_dev_path = xen_bus_get_dev_path;
- bus_class->realize = xen_bus_realize;
- bus_class->unrealize = xen_bus_unrealize;
- hotplug_class->unplug_request = xen_bus_unplug_request;
- }
- static const TypeInfo xen_bus_type_info = {
- .name = TYPE_XEN_BUS,
- .parent = TYPE_BUS,
- .instance_size = sizeof(XenBus),
- .class_size = sizeof(XenBusClass),
- .class_init = xen_bus_class_init,
- .interfaces = (InterfaceInfo[]) {
- { TYPE_HOTPLUG_HANDLER },
- { }
- },
- };
- void xen_device_backend_printf(XenDevice *xendev, const char *key,
- const char *fmt, ...)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- Error *local_err = NULL;
- va_list ap;
- g_assert(xenbus->xsh);
- va_start(ap, fmt);
- xs_node_vprintf(xenbus->xsh, XBT_NULL, xendev->backend_path, key,
- &local_err, fmt, ap);
- va_end(ap);
- if (local_err) {
- error_report_err(local_err);
- }
- }
- static int xen_device_backend_scanf(XenDevice *xendev, const char *key,
- const char *fmt, ...)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- va_list ap;
- int rc;
- g_assert(xenbus->xsh);
- va_start(ap, fmt);
- rc = xs_node_vscanf(xenbus->xsh, XBT_NULL, xendev->backend_path, key,
- NULL, fmt, ap);
- va_end(ap);
- return rc;
- }
- void xen_device_backend_set_state(XenDevice *xendev,
- enum xenbus_state state)
- {
- const char *type = object_get_typename(OBJECT(xendev));
- if (xendev->backend_state == state) {
- return;
- }
- trace_xen_device_backend_state(type, xendev->name,
- xs_strstate(state));
- xendev->backend_state = state;
- xen_device_backend_printf(xendev, "state", "%u", state);
- }
- enum xenbus_state xen_device_backend_get_state(XenDevice *xendev)
- {
- return xendev->backend_state;
- }
- static void xen_device_backend_set_online(XenDevice *xendev, bool online)
- {
- const char *type = object_get_typename(OBJECT(xendev));
- if (xendev->backend_online == online) {
- return;
- }
- trace_xen_device_backend_online(type, xendev->name, online);
- xendev->backend_online = online;
- xen_device_backend_printf(xendev, "online", "%u", online);
- }
- /*
- * Tell from the state whether the frontend is likely alive,
- * i.e. it will react to a change of state of the backend.
- */
- static bool xen_device_frontend_is_active(XenDevice *xendev)
- {
- switch (xendev->frontend_state) {
- case XenbusStateInitWait:
- case XenbusStateInitialised:
- case XenbusStateConnected:
- case XenbusStateClosing:
- return true;
- default:
- return false;
- }
- }
- static void xen_device_backend_changed(void *opaque)
- {
- XenDevice *xendev = opaque;
- const char *type = object_get_typename(OBJECT(xendev));
- enum xenbus_state state;
- unsigned int online;
- trace_xen_device_backend_changed(type, xendev->name);
- if (xen_device_backend_scanf(xendev, "state", "%u", &state) != 1) {
- state = XenbusStateUnknown;
- }
- xen_device_backend_set_state(xendev, state);
- if (xen_device_backend_scanf(xendev, "online", "%u", &online) != 1) {
- online = 0;
- }
- xen_device_backend_set_online(xendev, !!online);
- /*
- * If the toolstack (or unplug request callback) has set the backend
- * state to Closing, but there is no active frontend then set the
- * backend state to Closed.
- */
- if (state == XenbusStateClosing &&
- !xen_device_frontend_is_active(xendev)) {
- xen_device_backend_set_state(xendev, XenbusStateClosed);
- }
- /*
- * If a backend is still 'online' then we should leave it alone but,
- * if a backend is not 'online', then the device is a candidate
- * for destruction. Hence add it to the 'inactive' list to be cleaned
- * by xen_bus_cleanup().
- */
- if (!online &&
- (state == XenbusStateClosed || state == XenbusStateInitialising ||
- state == XenbusStateInitWait || state == XenbusStateUnknown) &&
- !xendev->inactive) {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- xendev->inactive = true;
- QLIST_INSERT_HEAD(&xenbus->inactive_devices, xendev, list);
- /*
- * Re-write the state to cause a XenBus backend_watch notification,
- * resulting in a call to xen_bus_cleanup().
- */
- xen_device_backend_printf(xendev, "state", "%u", state);
- }
- }
- static XenWatch *xen_device_add_watch(XenDevice *xendev, const char *node,
- const char *key,
- XenWatchHandler handler,
- Error **errp)
- {
- const char *type = object_get_typename(OBJECT(xendev));
- trace_xen_device_add_watch(type, xendev->name, node, key);
- return watch_list_add(xendev->watch_list, node, key, handler, xendev,
- errp);
- }
- static void xen_device_remove_watch(XenDevice *xendev, XenWatch *watch,
- Error **errp)
- {
- const char *type = object_get_typename(OBJECT(xendev));
- trace_xen_device_remove_watch(type, xendev->name, watch->node,
- watch->key);
- watch_list_remove(xendev->watch_list, watch, errp);
- }
- static void xen_device_backend_create(XenDevice *xendev, Error **errp)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- struct xs_permissions perms[2];
- Error *local_err = NULL;
- xendev->backend_path = xen_device_get_backend_path(xendev);
- perms[0].id = xenbus->backend_id;
- perms[0].perms = XS_PERM_NONE;
- perms[1].id = xendev->frontend_id;
- perms[1].perms = XS_PERM_READ;
- g_assert(xenbus->xsh);
- xs_node_create(xenbus->xsh, XBT_NULL, xendev->backend_path, perms,
- ARRAY_SIZE(perms), &local_err);
- if (local_err) {
- error_propagate_prepend(errp, local_err,
- "failed to create backend: ");
- return;
- }
- xendev->backend_state_watch =
- xen_device_add_watch(xendev, xendev->backend_path,
- "state", xen_device_backend_changed,
- &local_err);
- if (local_err) {
- error_propagate_prepend(errp, local_err,
- "failed to watch backend state: ");
- return;
- }
- xendev->backend_online_watch =
- xen_device_add_watch(xendev, xendev->backend_path,
- "online", xen_device_backend_changed,
- &local_err);
- if (local_err) {
- error_propagate_prepend(errp, local_err,
- "failed to watch backend online: ");
- return;
- }
- }
- static void xen_device_backend_destroy(XenDevice *xendev)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- Error *local_err = NULL;
- if (xendev->backend_online_watch) {
- xen_device_remove_watch(xendev, xendev->backend_online_watch, NULL);
- xendev->backend_online_watch = NULL;
- }
- if (xendev->backend_state_watch) {
- xen_device_remove_watch(xendev, xendev->backend_state_watch, NULL);
- xendev->backend_state_watch = NULL;
- }
- if (!xendev->backend_path) {
- return;
- }
- g_assert(xenbus->xsh);
- xs_node_destroy(xenbus->xsh, XBT_NULL, xendev->backend_path,
- &local_err);
- g_free(xendev->backend_path);
- xendev->backend_path = NULL;
- if (local_err) {
- error_report_err(local_err);
- }
- }
- void xen_device_frontend_printf(XenDevice *xendev, const char *key,
- const char *fmt, ...)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- Error *local_err = NULL;
- va_list ap;
- g_assert(xenbus->xsh);
- va_start(ap, fmt);
- xs_node_vprintf(xenbus->xsh, XBT_NULL, xendev->frontend_path, key,
- &local_err, fmt, ap);
- va_end(ap);
- if (local_err) {
- error_report_err(local_err);
- }
- }
- int xen_device_frontend_scanf(XenDevice *xendev, const char *key,
- const char *fmt, ...)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- va_list ap;
- int rc;
- g_assert(xenbus->xsh);
- va_start(ap, fmt);
- rc = xs_node_vscanf(xenbus->xsh, XBT_NULL, xendev->frontend_path, key,
- NULL, fmt, ap);
- va_end(ap);
- return rc;
- }
- static void xen_device_frontend_set_state(XenDevice *xendev,
- enum xenbus_state state,
- bool publish)
- {
- const char *type = object_get_typename(OBJECT(xendev));
- if (xendev->frontend_state == state) {
- return;
- }
- trace_xen_device_frontend_state(type, xendev->name,
- xs_strstate(state));
- xendev->frontend_state = state;
- if (publish) {
- xen_device_frontend_printf(xendev, "state", "%u", state);
- }
- }
- static void xen_device_frontend_changed(void *opaque)
- {
- XenDevice *xendev = opaque;
- XenDeviceClass *xendev_class = XEN_DEVICE_GET_CLASS(xendev);
- const char *type = object_get_typename(OBJECT(xendev));
- enum xenbus_state state;
- trace_xen_device_frontend_changed(type, xendev->name);
- if (xen_device_frontend_scanf(xendev, "state", "%u", &state) != 1) {
- state = XenbusStateUnknown;
- }
- xen_device_frontend_set_state(xendev, state, false);
- if (state == XenbusStateInitialising &&
- xendev->backend_state == XenbusStateClosed &&
- xendev->backend_online) {
- /*
- * The frontend is re-initializing so switch back to
- * InitWait.
- */
- xen_device_backend_set_state(xendev, XenbusStateInitWait);
- return;
- }
- if (xendev_class->frontend_changed) {
- Error *local_err = NULL;
- xendev_class->frontend_changed(xendev, state, &local_err);
- if (local_err) {
- error_reportf_err(local_err, "frontend change error: ");
- }
- }
- }
- static bool xen_device_frontend_exists(XenDevice *xendev)
- {
- enum xenbus_state state;
- return (xen_device_frontend_scanf(xendev, "state", "%u", &state) == 1);
- }
- static void xen_device_frontend_create(XenDevice *xendev, Error **errp)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- struct xs_permissions perms[2];
- Error *local_err = NULL;
- xendev->frontend_path = xen_device_get_frontend_path(xendev);
- /*
- * The frontend area may have already been created by a legacy
- * toolstack.
- */
- if (!xen_device_frontend_exists(xendev)) {
- perms[0].id = xendev->frontend_id;
- perms[0].perms = XS_PERM_NONE;
- perms[1].id = xenbus->backend_id;
- perms[1].perms = XS_PERM_READ | XS_PERM_WRITE;
- g_assert(xenbus->xsh);
- xs_node_create(xenbus->xsh, XBT_NULL, xendev->frontend_path, perms,
- ARRAY_SIZE(perms), &local_err);
- if (local_err) {
- error_propagate_prepend(errp, local_err,
- "failed to create frontend: ");
- return;
- }
- }
- xendev->frontend_state_watch =
- xen_device_add_watch(xendev, xendev->frontend_path, "state",
- xen_device_frontend_changed, &local_err);
- if (local_err) {
- error_propagate_prepend(errp, local_err,
- "failed to watch frontend state: ");
- }
- }
- static void xen_device_frontend_destroy(XenDevice *xendev)
- {
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- Error *local_err = NULL;
- if (xendev->frontend_state_watch) {
- xen_device_remove_watch(xendev, xendev->frontend_state_watch,
- NULL);
- xendev->frontend_state_watch = NULL;
- }
- if (!xendev->frontend_path) {
- return;
- }
- g_assert(xenbus->xsh);
- xs_node_destroy(xenbus->xsh, XBT_NULL, xendev->frontend_path,
- &local_err);
- g_free(xendev->frontend_path);
- xendev->frontend_path = NULL;
- if (local_err) {
- error_report_err(local_err);
- }
- }
- void xen_device_set_max_grant_refs(XenDevice *xendev, unsigned int nr_refs,
- Error **errp)
- {
- if (xengnttab_set_max_grants(xendev->xgth, nr_refs)) {
- error_setg_errno(errp, errno, "xengnttab_set_max_grants failed");
- }
- }
- void *xen_device_map_grant_refs(XenDevice *xendev, uint32_t *refs,
- unsigned int nr_refs, int prot,
- Error **errp)
- {
- void *map = xengnttab_map_domain_grant_refs(xendev->xgth, nr_refs,
- xendev->frontend_id, refs,
- prot);
- if (!map) {
- error_setg_errno(errp, errno,
- "xengnttab_map_domain_grant_refs failed");
- }
- return map;
- }
- void xen_device_unmap_grant_refs(XenDevice *xendev, void *map,
- unsigned int nr_refs, Error **errp)
- {
- if (xengnttab_unmap(xendev->xgth, map, nr_refs)) {
- error_setg_errno(errp, errno, "xengnttab_unmap failed");
- }
- }
- static void compat_copy_grant_refs(XenDevice *xendev, bool to_domain,
- XenDeviceGrantCopySegment segs[],
- unsigned int nr_segs, Error **errp)
- {
- uint32_t *refs = g_new(uint32_t, nr_segs);
- int prot = to_domain ? PROT_WRITE : PROT_READ;
- void *map;
- unsigned int i;
- for (i = 0; i < nr_segs; i++) {
- XenDeviceGrantCopySegment *seg = &segs[i];
- refs[i] = to_domain ? seg->dest.foreign.ref :
- seg->source.foreign.ref;
- }
- map = xengnttab_map_domain_grant_refs(xendev->xgth, nr_segs,
- xendev->frontend_id, refs,
- prot);
- if (!map) {
- error_setg_errno(errp, errno,
- "xengnttab_map_domain_grant_refs failed");
- goto done;
- }
- for (i = 0; i < nr_segs; i++) {
- XenDeviceGrantCopySegment *seg = &segs[i];
- void *page = map + (i * XC_PAGE_SIZE);
- if (to_domain) {
- memcpy(page + seg->dest.foreign.offset, seg->source.virt,
- seg->len);
- } else {
- memcpy(seg->dest.virt, page + seg->source.foreign.offset,
- seg->len);
- }
- }
- if (xengnttab_unmap(xendev->xgth, map, nr_segs)) {
- error_setg_errno(errp, errno, "xengnttab_unmap failed");
- }
- done:
- g_free(refs);
- }
- void xen_device_copy_grant_refs(XenDevice *xendev, bool to_domain,
- XenDeviceGrantCopySegment segs[],
- unsigned int nr_segs, Error **errp)
- {
- xengnttab_grant_copy_segment_t *xengnttab_segs;
- unsigned int i;
- if (!xendev->feature_grant_copy) {
- compat_copy_grant_refs(xendev, to_domain, segs, nr_segs, errp);
- return;
- }
- xengnttab_segs = g_new0(xengnttab_grant_copy_segment_t, nr_segs);
- for (i = 0; i < nr_segs; i++) {
- XenDeviceGrantCopySegment *seg = &segs[i];
- xengnttab_grant_copy_segment_t *xengnttab_seg = &xengnttab_segs[i];
- if (to_domain) {
- xengnttab_seg->flags = GNTCOPY_dest_gref;
- xengnttab_seg->dest.foreign.domid = xendev->frontend_id;
- xengnttab_seg->dest.foreign.ref = seg->dest.foreign.ref;
- xengnttab_seg->dest.foreign.offset = seg->dest.foreign.offset;
- xengnttab_seg->source.virt = seg->source.virt;
- } else {
- xengnttab_seg->flags = GNTCOPY_source_gref;
- xengnttab_seg->source.foreign.domid = xendev->frontend_id;
- xengnttab_seg->source.foreign.ref = seg->source.foreign.ref;
- xengnttab_seg->source.foreign.offset =
- seg->source.foreign.offset;
- xengnttab_seg->dest.virt = seg->dest.virt;
- }
- xengnttab_seg->len = seg->len;
- }
- if (xengnttab_grant_copy(xendev->xgth, nr_segs, xengnttab_segs)) {
- error_setg_errno(errp, errno, "xengnttab_grant_copy failed");
- goto done;
- }
- for (i = 0; i < nr_segs; i++) {
- xengnttab_grant_copy_segment_t *xengnttab_seg = &xengnttab_segs[i];
- if (xengnttab_seg->status != GNTST_okay) {
- error_setg(errp, "xengnttab_grant_copy seg[%u] failed", i);
- break;
- }
- }
- done:
- g_free(xengnttab_segs);
- }
- struct XenEventChannel {
- QLIST_ENTRY(XenEventChannel) list;
- AioContext *ctx;
- xenevtchn_handle *xeh;
- evtchn_port_t local_port;
- XenEventHandler handler;
- void *opaque;
- };
- static bool xen_device_poll(void *opaque)
- {
- XenEventChannel *channel = opaque;
- return channel->handler(channel->opaque);
- }
- static void xen_device_event(void *opaque)
- {
- XenEventChannel *channel = opaque;
- unsigned long port = xenevtchn_pending(channel->xeh);
- if (port == channel->local_port) {
- xen_device_poll(channel);
- xenevtchn_unmask(channel->xeh, port);
- }
- }
- XenEventChannel *xen_device_bind_event_channel(XenDevice *xendev,
- AioContext *ctx,
- unsigned int port,
- XenEventHandler handler,
- void *opaque, Error **errp)
- {
- XenEventChannel *channel = g_new0(XenEventChannel, 1);
- xenevtchn_port_or_error_t local_port;
- channel->xeh = xenevtchn_open(NULL, 0);
- if (!channel->xeh) {
- error_setg_errno(errp, errno, "failed xenevtchn_open");
- goto fail;
- }
- local_port = xenevtchn_bind_interdomain(channel->xeh,
- xendev->frontend_id,
- port);
- if (local_port < 0) {
- error_setg_errno(errp, errno, "xenevtchn_bind_interdomain failed");
- goto fail;
- }
- channel->local_port = local_port;
- channel->handler = handler;
- channel->opaque = opaque;
- channel->ctx = ctx;
- aio_set_fd_handler(channel->ctx, xenevtchn_fd(channel->xeh), true,
- xen_device_event, NULL, xen_device_poll, channel);
- QLIST_INSERT_HEAD(&xendev->event_channels, channel, list);
- return channel;
- fail:
- if (channel->xeh) {
- xenevtchn_close(channel->xeh);
- }
- g_free(channel);
- return NULL;
- }
- void xen_device_notify_event_channel(XenDevice *xendev,
- XenEventChannel *channel,
- Error **errp)
- {
- if (!channel) {
- error_setg(errp, "bad channel");
- return;
- }
- if (xenevtchn_notify(channel->xeh, channel->local_port) < 0) {
- error_setg_errno(errp, errno, "xenevtchn_notify failed");
- }
- }
- void xen_device_unbind_event_channel(XenDevice *xendev,
- XenEventChannel *channel,
- Error **errp)
- {
- if (!channel) {
- error_setg(errp, "bad channel");
- return;
- }
- QLIST_REMOVE(channel, list);
- aio_set_fd_handler(channel->ctx, xenevtchn_fd(channel->xeh), true,
- NULL, NULL, NULL, NULL);
- if (xenevtchn_unbind(channel->xeh, channel->local_port) < 0) {
- error_setg_errno(errp, errno, "xenevtchn_unbind failed");
- }
- xenevtchn_close(channel->xeh);
- g_free(channel);
- }
- static void xen_device_unrealize(DeviceState *dev, Error **errp)
- {
- XenDevice *xendev = XEN_DEVICE(dev);
- XenDeviceClass *xendev_class = XEN_DEVICE_GET_CLASS(xendev);
- const char *type = object_get_typename(OBJECT(xendev));
- XenEventChannel *channel, *next;
- if (!xendev->name) {
- return;
- }
- trace_xen_device_unrealize(type, xendev->name);
- if (xendev->exit.notify) {
- qemu_remove_exit_notifier(&xendev->exit);
- xendev->exit.notify = NULL;
- }
- if (xendev_class->unrealize) {
- xendev_class->unrealize(xendev, errp);
- }
- /* Make sure all event channels are cleaned up */
- QLIST_FOREACH_SAFE(channel, &xendev->event_channels, list, next) {
- xen_device_unbind_event_channel(xendev, channel, NULL);
- }
- xen_device_frontend_destroy(xendev);
- xen_device_backend_destroy(xendev);
- if (xendev->xgth) {
- xengnttab_close(xendev->xgth);
- xendev->xgth = NULL;
- }
- if (xendev->watch_list) {
- watch_list_destroy(xendev->watch_list);
- xendev->watch_list = NULL;
- }
- if (xendev->xsh) {
- xs_close(xendev->xsh);
- xendev->xsh = NULL;
- }
- g_free(xendev->name);
- xendev->name = NULL;
- }
- static void xen_device_exit(Notifier *n, void *data)
- {
- XenDevice *xendev = container_of(n, XenDevice, exit);
- xen_device_unrealize(DEVICE(xendev), &error_abort);
- }
- static void xen_device_realize(DeviceState *dev, Error **errp)
- {
- XenDevice *xendev = XEN_DEVICE(dev);
- XenDeviceClass *xendev_class = XEN_DEVICE_GET_CLASS(xendev);
- XenBus *xenbus = XEN_BUS(qdev_get_parent_bus(DEVICE(xendev)));
- const char *type = object_get_typename(OBJECT(xendev));
- Error *local_err = NULL;
- if (xendev->frontend_id == DOMID_INVALID) {
- xendev->frontend_id = xen_domid;
- }
- if (xendev->frontend_id >= DOMID_FIRST_RESERVED) {
- error_setg(errp, "invalid frontend-id");
- goto unrealize;
- }
- if (!xendev_class->get_name) {
- error_setg(errp, "get_name method not implemented");
- goto unrealize;
- }
- xendev->name = xendev_class->get_name(xendev, &local_err);
- if (local_err) {
- error_propagate_prepend(errp, local_err,
- "failed to get device name: ");
- goto unrealize;
- }
- trace_xen_device_realize(type, xendev->name);
- xendev->xsh = xs_open(0);
- if (!xendev->xsh) {
- error_setg_errno(errp, errno, "failed xs_open");
- goto unrealize;
- }
- xendev->watch_list = watch_list_create(xendev->xsh);
- xendev->xgth = xengnttab_open(NULL, 0);
- if (!xendev->xgth) {
- error_setg_errno(errp, errno, "failed xengnttab_open");
- goto unrealize;
- }
- xendev->feature_grant_copy =
- (xengnttab_grant_copy(xendev->xgth, 0, NULL) == 0);
- xen_device_backend_create(xendev, &local_err);
- if (local_err) {
- error_propagate(errp, local_err);
- goto unrealize;
- }
- xen_device_frontend_create(xendev, &local_err);
- if (local_err) {
- error_propagate(errp, local_err);
- goto unrealize;
- }
- if (xendev_class->realize) {
- xendev_class->realize(xendev, &local_err);
- if (local_err) {
- error_propagate(errp, local_err);
- goto unrealize;
- }
- }
- xen_device_backend_printf(xendev, "frontend", "%s",
- xendev->frontend_path);
- xen_device_backend_printf(xendev, "frontend-id", "%u",
- xendev->frontend_id);
- xen_device_backend_printf(xendev, "hotplug-status", "connected");
- xen_device_backend_set_online(xendev, true);
- xen_device_backend_set_state(xendev, XenbusStateInitWait);
- if (!xen_device_frontend_exists(xendev)) {
- xen_device_frontend_printf(xendev, "backend", "%s",
- xendev->backend_path);
- xen_device_frontend_printf(xendev, "backend-id", "%u",
- xenbus->backend_id);
- xen_device_frontend_set_state(xendev, XenbusStateInitialising, true);
- }
- xendev->exit.notify = xen_device_exit;
- qemu_add_exit_notifier(&xendev->exit);
- return;
- unrealize:
- xen_device_unrealize(dev, &error_abort);
- }
- static Property xen_device_props[] = {
- DEFINE_PROP_UINT16("frontend-id", XenDevice, frontend_id,
- DOMID_INVALID),
- DEFINE_PROP_END_OF_LIST()
- };
- static void xen_device_class_init(ObjectClass *class, void *data)
- {
- DeviceClass *dev_class = DEVICE_CLASS(class);
- dev_class->realize = xen_device_realize;
- dev_class->unrealize = xen_device_unrealize;
- dev_class->props = xen_device_props;
- dev_class->bus_type = TYPE_XEN_BUS;
- }
- static const TypeInfo xen_device_type_info = {
- .name = TYPE_XEN_DEVICE,
- .parent = TYPE_DEVICE,
- .instance_size = sizeof(XenDevice),
- .abstract = true,
- .class_size = sizeof(XenDeviceClass),
- .class_init = xen_device_class_init,
- };
- typedef struct XenBridge {
- SysBusDevice busdev;
- } XenBridge;
- #define TYPE_XEN_BRIDGE "xen-bridge"
- static const TypeInfo xen_bridge_type_info = {
- .name = TYPE_XEN_BRIDGE,
- .parent = TYPE_SYS_BUS_DEVICE,
- .instance_size = sizeof(XenBridge),
- };
- static void xen_register_types(void)
- {
- type_register_static(&xen_bridge_type_info);
- type_register_static(&xen_bus_type_info);
- type_register_static(&xen_device_type_info);
- }
- type_init(xen_register_types)
- void xen_bus_init(void)
- {
- DeviceState *dev = qdev_create(NULL, TYPE_XEN_BRIDGE);
- BusState *bus = qbus_create(TYPE_XEN_BUS, dev, NULL);
- qdev_init_nofail(dev);
- qbus_set_bus_hotplug_handler(bus, &error_abort);
- }
|