Home | History | Annotate | Line # | Download | only in xenbus
xenbus_probe.c revision 1.58.6.2
      1  1.58.6.2    martin /* $NetBSD: xenbus_probe.c,v 1.58.6.2 2025/02/20 19:32:55 martin Exp $ */
      2       1.1    bouyer /******************************************************************************
      3       1.1    bouyer  * Talks to Xen Store to figure out what devices we have.
      4       1.1    bouyer  *
      5       1.1    bouyer  * Copyright (C) 2005 Rusty Russell, IBM Corporation
      6       1.1    bouyer  * Copyright (C) 2005 Mike Wray, Hewlett-Packard
      7       1.1    bouyer  * Copyright (C) 2005 XenSource Ltd
      8       1.1    bouyer  *
      9       1.1    bouyer  * This file may be distributed separately from the Linux kernel, or
     10       1.1    bouyer  * incorporated into other software packages, subject to the following license:
     11       1.1    bouyer  *
     12       1.1    bouyer  * Permission is hereby granted, free of charge, to any person obtaining a copy
     13       1.1    bouyer  * of this source file (the "Software"), to deal in the Software without
     14       1.1    bouyer  * restriction, including without limitation the rights to use, copy, modify,
     15       1.1    bouyer  * merge, publish, distribute, sublicense, and/or sell copies of the Software,
     16       1.1    bouyer  * and to permit persons to whom the Software is furnished to do so, subject to
     17       1.1    bouyer  * the following conditions:
     18       1.1    bouyer  *
     19       1.1    bouyer  * The above copyright notice and this permission notice shall be included in
     20       1.1    bouyer  * all copies or substantial portions of the Software.
     21       1.1    bouyer  *
     22       1.1    bouyer  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
     23       1.1    bouyer  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
     24       1.1    bouyer  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
     25       1.1    bouyer  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
     26       1.1    bouyer  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
     27       1.1    bouyer  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
     28       1.1    bouyer  * IN THE SOFTWARE.
     29       1.1    bouyer  */
     30       1.1    bouyer 
     31       1.2    bouyer #include <sys/cdefs.h>
     32  1.58.6.2    martin __KERNEL_RCSID(0, "$NetBSD: xenbus_probe.c,v 1.58.6.2 2025/02/20 19:32:55 martin Exp $");
     33       1.2    bouyer 
     34       1.1    bouyer #if 0
     35       1.1    bouyer #define DPRINTK(fmt, args...) \
     36      1.18     perry     printf("xenbus_probe (%s:%d) " fmt ".\n", __func__, __LINE__, ##args)
     37       1.1    bouyer #else
     38       1.1    bouyer #define DPRINTK(fmt, args...) ((void)0)
     39       1.1    bouyer #endif
     40       1.1    bouyer 
     41       1.2    bouyer #include <sys/types.h>
     42       1.2    bouyer #include <sys/null.h>
     43       1.2    bouyer #include <sys/errno.h>
     44      1.44  jdolecek #include <sys/kmem.h>
     45       1.2    bouyer #include <sys/systm.h>
     46       1.2    bouyer #include <sys/param.h>
     47       1.2    bouyer #include <sys/kthread.h>
     48      1.52    bouyer #include <sys/mutex.h>
     49       1.7    bouyer #include <uvm/uvm.h>
     50       1.7    bouyer 
     51      1.26    cegger #include <xen/xen.h>	/* for xendomain_is_dom0() */
     52      1.17    bouyer #include <xen/hypervisor.h>
     53      1.17    bouyer #include <xen/xenbus.h>
     54      1.17    bouyer #include <xen/evtchn.h>
     55      1.17    bouyer #include <xen/shutdown_xenbus.h>
     56       1.1    bouyer 
     57       1.1    bouyer #include "xenbus_comms.h"
     58       1.1    bouyer 
     59      1.55    bouyer #include "kernfs.h"
     60      1.55    bouyer 
     61      1.20    cegger static int  xenbus_match(device_t, cfdata_t, void *);
     62      1.20    cegger static void xenbus_attach(device_t, device_t, void *);
     63       1.2    bouyer static int  xenbus_print(void *, const char *);
     64       1.2    bouyer 
     65      1.34       jym /* power management, for save/restore */
     66      1.34       jym static bool xenbus_suspend(device_t, const pmf_qual_t *);
     67      1.34       jym static bool xenbus_resume(device_t, const pmf_qual_t *);
     68      1.34       jym 
     69      1.29       jym /* routines gathering device information from XenStore */
     70      1.29       jym static int  read_otherend_details(struct xenbus_device *,
     71      1.29       jym 		const char *, const char *);
     72      1.29       jym static int  read_backend_details (struct xenbus_device *);
     73      1.29       jym static int  read_frontend_details(struct xenbus_device *);
     74      1.29       jym static void free_otherend_details(struct xenbus_device *);
     75      1.29       jym 
     76      1.29       jym static int  watch_otherend     (struct xenbus_device *);
     77      1.29       jym static void free_otherend_watch(struct xenbus_device *);
     78      1.29       jym 
     79       1.2    bouyer static void xenbus_probe_init(void *);
     80       1.2    bouyer 
     81       1.5    bouyer static struct xenbus_device *xenbus_lookup_device_path(const char *);
     82       1.5    bouyer 
     83      1.20    cegger CFATTACH_DECL_NEW(xenbus, 0, xenbus_match, xenbus_attach,
     84       1.2    bouyer     NULL, NULL);
     85       1.2    bouyer 
     86      1.24    cegger device_t xenbus_dev;
     87      1.48  jdolecek bus_dma_tag_t xenbus_dmat;
     88       1.5    bouyer 
     89       1.5    bouyer SLIST_HEAD(, xenbus_device) xenbus_device_list;
     90      1.11    bouyer SLIST_HEAD(, xenbus_backend_driver) xenbus_backend_driver_list =
     91      1.11    bouyer 	SLIST_HEAD_INITIALIZER(xenbus_backend_driver);
     92       1.2    bouyer 
     93       1.2    bouyer int
     94      1.20    cegger xenbus_match(device_t parent, cfdata_t match, void *aux)
     95       1.2    bouyer {
     96       1.2    bouyer 	struct xenbus_attach_args *xa = (struct xenbus_attach_args *)aux;
     97       1.2    bouyer 
     98       1.2    bouyer 	if (strcmp(xa->xa_device, "xenbus") == 0)
     99       1.2    bouyer 		return 1;
    100       1.2    bouyer 	return 0;
    101       1.2    bouyer }
    102       1.2    bouyer 
    103       1.2    bouyer static void
    104      1.20    cegger xenbus_attach(device_t parent, device_t self, void *aux)
    105       1.2    bouyer {
    106      1.48  jdolecek 	struct xenbus_attach_args *xa = (struct xenbus_attach_args *)aux;
    107      1.15        ad 	int err;
    108      1.15        ad 
    109       1.2    bouyer 	aprint_normal(": Xen Virtual Bus Interface\n");
    110      1.24    cegger 	xenbus_dev = self;
    111      1.48  jdolecek 	xenbus_dmat = xa->xa_dmat;
    112      1.38       riz 	config_pending_incr(self);
    113      1.15        ad 
    114      1.52    bouyer 	err = kthread_create(PRI_NONE, KTHREAD_MPSAFE, NULL,
    115      1.52    bouyer 	    xenbus_probe_init, NULL, NULL, "xenbus_probe");
    116      1.15        ad 	if (err)
    117      1.24    cegger 		aprint_error_dev(xenbus_dev,
    118      1.23    cegger 				"kthread_create(xenbus_probe): %d\n", err);
    119      1.34       jym 
    120      1.34       jym 	if (!pmf_device_register(self, xenbus_suspend, xenbus_resume))
    121      1.34       jym 		aprint_error_dev(self, "couldn't establish power handler\n");
    122      1.34       jym }
    123      1.34       jym 
    124      1.34       jym static bool
    125      1.34       jym xenbus_suspend(device_t dev, const pmf_qual_t *qual)
    126      1.34       jym {
    127      1.34       jym 	xs_suspend();
    128      1.34       jym 	xb_suspend_comms(dev);
    129      1.34       jym 
    130      1.34       jym 	return true;
    131      1.34       jym }
    132      1.34       jym 
    133      1.34       jym static bool
    134      1.34       jym xenbus_resume(device_t dev, const pmf_qual_t *qual)
    135      1.34       jym {
    136      1.53  jdolecek 	xb_resume_comms(dev);
    137      1.34       jym 	xs_resume();
    138      1.34       jym 
    139      1.34       jym 	return true;
    140      1.34       jym }
    141      1.34       jym 
    142      1.34       jym /*
    143      1.34       jym  * Suspend a xenbus device
    144      1.34       jym  */
    145      1.34       jym bool
    146      1.34       jym xenbus_device_suspend(struct xenbus_device *dev) {
    147      1.34       jym 
    148      1.34       jym 	free_otherend_details(dev);
    149      1.34       jym 	return true;
    150      1.34       jym }
    151      1.34       jym 
    152      1.34       jym /*
    153      1.34       jym  * Resume a xenbus device
    154      1.34       jym  */
    155      1.34       jym bool
    156      1.34       jym xenbus_device_resume(struct xenbus_device *dev) {
    157      1.34       jym 
    158      1.34       jym 	if (dev->xbusd_type == XENBUS_FRONTEND_DEVICE) {
    159      1.34       jym 		read_backend_details(dev);
    160      1.34       jym 	}
    161      1.34       jym 
    162      1.34       jym 	return true;
    163       1.2    bouyer }
    164       1.2    bouyer 
    165       1.2    bouyer void
    166      1.11    bouyer xenbus_backend_register(struct xenbus_backend_driver *xbakd)
    167      1.11    bouyer {
    168      1.11    bouyer 	SLIST_INSERT_HEAD(&xenbus_backend_driver_list, xbakd, xbakd_entries);
    169      1.11    bouyer }
    170      1.11    bouyer 
    171       1.2    bouyer static int
    172       1.2    bouyer read_otherend_details(struct xenbus_device *xendev,
    173       1.2    bouyer 				 const char *id_node, const char *path_node)
    174       1.2    bouyer {
    175       1.2    bouyer 	int err;
    176      1.42  jdolecek 	unsigned long id;
    177       1.1    bouyer 
    178      1.42  jdolecek 	err = xenbus_read_ul(NULL, xendev->xbusd_path, id_node, &id, 10);
    179       1.2    bouyer 	if (err) {
    180       1.2    bouyer 		printf("reading other end details %s from %s\n",
    181       1.2    bouyer 		    id_node, xendev->xbusd_path);
    182       1.2    bouyer 		xenbus_dev_fatal(xendev, err,
    183       1.2    bouyer 				 "reading other end details %s from %s",
    184       1.2    bouyer 				 id_node, xendev->xbusd_path);
    185       1.2    bouyer 		return err;
    186       1.2    bouyer 	}
    187      1.42  jdolecek 	xendev->xbusd_otherend_id = (int)id;
    188      1.42  jdolecek 
    189      1.42  jdolecek 	err = xenbus_read(NULL, xendev->xbusd_path, path_node,
    190      1.42  jdolecek 	    xendev->xbusd_otherend, sizeof(xendev->xbusd_otherend));
    191       1.1    bouyer 	if (err) {
    192       1.2    bouyer 		printf("reading other end details %s from %s (%d)\n",
    193       1.2    bouyer 		    path_node, xendev->xbusd_path, err);
    194       1.1    bouyer 		xenbus_dev_fatal(xendev, err,
    195       1.2    bouyer 				 "reading other end details %s from %s",
    196       1.2    bouyer 				 path_node, xendev->xbusd_path);
    197       1.1    bouyer 		return err;
    198       1.1    bouyer 	}
    199       1.3    bouyer 	DPRINTK("read_otherend_details: read %s/%s returned %s\n",
    200      1.54  jdolecek 	    xendev->xbusd_path, path_node, xendev->xbusd_otherend);
    201       1.2    bouyer 
    202       1.2    bouyer 	if (strlen(xendev->xbusd_otherend) == 0 ||
    203       1.2    bouyer 	    !xenbus_exists(NULL, xendev->xbusd_otherend, "")) {
    204       1.2    bouyer 		printf("missing other end from %s\n", xendev->xbusd_path);
    205       1.1    bouyer 		xenbus_dev_fatal(xendev, -ENOENT, "missing other end from %s",
    206       1.2    bouyer 				 xendev->xbusd_path);
    207      1.29       jym 		free_otherend_details(xendev);
    208       1.2    bouyer 		return ENOENT;
    209       1.1    bouyer 	}
    210       1.1    bouyer 
    211       1.1    bouyer 	return 0;
    212       1.1    bouyer }
    213       1.1    bouyer 
    214       1.2    bouyer static int
    215       1.2    bouyer read_backend_details(struct xenbus_device *xendev)
    216       1.1    bouyer {
    217       1.1    bouyer 	return read_otherend_details(xendev, "backend-id", "backend");
    218       1.1    bouyer }
    219       1.1    bouyer 
    220       1.1    bouyer 
    221       1.2    bouyer static int
    222       1.2    bouyer read_frontend_details(struct xenbus_device *xendev)
    223       1.1    bouyer {
    224       1.1    bouyer 	return read_otherend_details(xendev, "frontend-id", "frontend");
    225       1.1    bouyer }
    226       1.1    bouyer 
    227       1.2    bouyer static void
    228       1.2    bouyer free_otherend_details(struct xenbus_device *dev)
    229       1.1    bouyer {
    230      1.42  jdolecek 	/* Nothing to free */
    231      1.42  jdolecek 	dev->xbusd_otherend[0] = '\0';
    232       1.1    bouyer }
    233       1.1    bouyer 
    234       1.2    bouyer static void
    235       1.2    bouyer free_otherend_watch(struct xenbus_device *dev)
    236       1.1    bouyer {
    237      1.44  jdolecek 	if (dev->xbusd_otherend_watch.node)
    238      1.44  jdolecek 		xenbus_unwatch_path(&dev->xbusd_otherend_watch);
    239       1.1    bouyer }
    240       1.1    bouyer 
    241       1.2    bouyer static void
    242       1.2    bouyer otherend_changed(struct xenbus_watch *watch,
    243       1.1    bouyer 			     const char **vec, unsigned int len)
    244       1.1    bouyer {
    245       1.3    bouyer 	struct xenbus_device *xdev = watch->xbw_dev;
    246       1.1    bouyer 	XenbusState state;
    247       1.1    bouyer 
    248       1.1    bouyer 	/* Protect us against watches firing on old details when the otherend
    249       1.1    bouyer 	   details change, say immediately after a resume. */
    250       1.3    bouyer 	if (!xdev->xbusd_otherend ||
    251       1.3    bouyer 	    strncmp(xdev->xbusd_otherend, vec[XS_WATCH_PATH],
    252       1.3    bouyer 		    strlen(xdev->xbusd_otherend))) {
    253       1.1    bouyer 		DPRINTK("Ignoring watch at %s", vec[XS_WATCH_PATH]);
    254       1.1    bouyer 		return;
    255       1.1    bouyer 	}
    256       1.1    bouyer 
    257       1.3    bouyer 	state = xenbus_read_driver_state(xdev->xbusd_otherend);
    258       1.1    bouyer 
    259       1.1    bouyer 	DPRINTK("state is %d, %s, %s",
    260       1.3    bouyer 		state, xdev->xbusd_otherend_watch.node, vec[XS_WATCH_PATH]);
    261       1.5    bouyer 	if (state == XenbusStateClosed) {
    262       1.5    bouyer 		int error;
    263      1.11    bouyer 		if (xdev->xbusd_type == XENBUS_BACKEND_DEVICE) {
    264      1.11    bouyer 			error = xdev->xbusd_u.b.b_detach(
    265      1.11    bouyer 			    xdev->xbusd_u.b.b_cookie);
    266      1.11    bouyer 			if (error) {
    267      1.11    bouyer 				printf("could not detach %s: %d\n",
    268      1.11    bouyer 				    xdev->xbusd_path, error);
    269      1.11    bouyer 				return;
    270      1.11    bouyer 			}
    271      1.11    bouyer 		} else {
    272      1.11    bouyer 			error = config_detach(xdev->xbusd_u.f.f_dev,
    273      1.11    bouyer 			    DETACH_FORCE);
    274      1.11    bouyer 			if (error) {
    275      1.11    bouyer 				printf("could not detach %s: %d\n",
    276      1.19    cegger 				    device_xname(xdev->xbusd_u.f.f_dev), error);
    277      1.11    bouyer 				return;
    278      1.11    bouyer 			}
    279       1.5    bouyer 		}
    280       1.5    bouyer 		xenbus_free_device(xdev);
    281       1.5    bouyer 		return;
    282       1.5    bouyer 	}
    283       1.3    bouyer 	if (xdev->xbusd_otherend_changed)
    284      1.11    bouyer 		xdev->xbusd_otherend_changed(
    285      1.11    bouyer 		    (xdev->xbusd_type == XENBUS_BACKEND_DEVICE) ?
    286      1.11    bouyer 		    xdev->xbusd_u.b.b_cookie : xdev->xbusd_u.f.f_dev, state);
    287       1.1    bouyer }
    288       1.1    bouyer 
    289       1.2    bouyer static int
    290      1.29       jym watch_otherend(struct xenbus_device *dev)
    291       1.1    bouyer {
    292       1.1    bouyer 	free_otherend_watch(dev);
    293       1.1    bouyer 
    294       1.2    bouyer 	return xenbus_watch_path2(dev, dev->xbusd_otherend, "state",
    295       1.3    bouyer 				  &dev->xbusd_otherend_watch,
    296       1.3    bouyer 				  otherend_changed);
    297       1.1    bouyer }
    298       1.1    bouyer 
    299       1.5    bouyer static struct xenbus_device *
    300       1.5    bouyer xenbus_lookup_device_path(const char *path)
    301       1.5    bouyer {
    302       1.5    bouyer 	struct xenbus_device *xbusd;
    303       1.5    bouyer 
    304       1.5    bouyer 	SLIST_FOREACH(xbusd, &xenbus_device_list, xbusd_entries) {
    305       1.5    bouyer 		if (strcmp(xbusd->xbusd_path, path) == 0)
    306       1.5    bouyer 			return xbusd;
    307       1.5    bouyer 	}
    308       1.5    bouyer 	return NULL;
    309       1.5    bouyer }
    310       1.5    bouyer 
    311       1.2    bouyer static int
    312      1.11    bouyer xenbus_probe_device_type(const char *path, const char *type,
    313      1.11    bouyer     int (*create)(struct xenbus_device *))
    314       1.1    bouyer {
    315      1.36  sborrill 	int err, i, pos, msize;
    316      1.36  sborrill 	int *lookup = NULL;
    317      1.45  jdolecek 	size_t lookup_sz = 0;
    318      1.11    bouyer 	unsigned long state;
    319       1.1    bouyer 	char **dir;
    320      1.46  jdolecek 	unsigned int orig_dir_n = 0, dir_n;
    321       1.2    bouyer 	struct xenbus_device *xbusd;
    322       1.2    bouyer 	struct xenbusdev_attach_args xa;
    323       1.2    bouyer 	char *ep;
    324       1.2    bouyer 
    325      1.11    bouyer 	DPRINTK("probe %s type %s", path, type);
    326      1.46  jdolecek 	err = xenbus_directory(NULL, path, "", &orig_dir_n, &dir);
    327      1.54  jdolecek 	DPRINTK("directory err %d dir_n %d", err, orig_dir_n);
    328       1.2    bouyer 	if (err)
    329       1.2    bouyer 		return err;
    330      1.46  jdolecek 	dir_n = orig_dir_n;
    331       1.1    bouyer 
    332      1.36  sborrill 	/* Only sort frontend devices i.e. create == NULL*/
    333      1.36  sborrill 	if (dir_n > 1 && create == NULL) {
    334      1.36  sborrill 		int minp;
    335      1.36  sborrill 		unsigned long minv;
    336      1.36  sborrill 		unsigned long *id;
    337      1.45  jdolecek 		size_t id_sz;
    338      1.36  sborrill 
    339      1.45  jdolecek 		lookup_sz = sizeof(int) * dir_n;
    340      1.45  jdolecek 		lookup = kmem_zalloc(lookup_sz, KM_SLEEP);
    341      1.45  jdolecek 
    342      1.45  jdolecek 		id_sz = sizeof(unsigned long) * dir_n;
    343      1.45  jdolecek 		id = kmem_zalloc(id_sz, KM_SLEEP);
    344      1.36  sborrill 
    345      1.36  sborrill 		/* Convert string values to numeric; skip invalid */
    346      1.36  sborrill 		for (i = 0; i < dir_n; i++) {
    347      1.37  sborrill 			/*
    348      1.37  sborrill 			 * Add one to differentiate numerical zero from invalid
    349      1.37  sborrill 			 * string. Has no effect on sort order.
    350      1.37  sborrill 			 */
    351      1.37  sborrill 			id[i] = strtoul(dir[i], &ep, 10) + 1;
    352      1.36  sborrill 			if (dir[i][0] == '\0' || *ep != '\0')
    353      1.36  sborrill 				id[i] = 0;
    354      1.36  sborrill 		}
    355      1.36  sborrill 
    356      1.36  sborrill 		/* Build lookup table in ascending order */
    357      1.36  sborrill 		for (pos = 0; pos < dir_n; ) {
    358      1.36  sborrill 			minv = UINT32_MAX;
    359      1.36  sborrill 			minp = -1;
    360      1.36  sborrill 			for (i = 0; i < dir_n; i++) {
    361      1.36  sborrill 				if (id[i] < minv && id[i] > 0) {
    362      1.36  sborrill 					minv = id[i];
    363      1.36  sborrill 					minp = i;
    364      1.36  sborrill 				}
    365      1.36  sborrill 			}
    366      1.36  sborrill 			if (minp >= 0) {
    367      1.36  sborrill 				lookup[pos++] = minp;
    368      1.36  sborrill 				id[minp] = 0;
    369      1.36  sborrill 			}
    370      1.36  sborrill 			else
    371      1.36  sborrill 				break;
    372      1.36  sborrill 		}
    373      1.45  jdolecek 
    374      1.45  jdolecek 		kmem_free(id, id_sz);
    375      1.45  jdolecek 
    376      1.36  sborrill 		/* Adjust in case we had to skip non-numeric entries */
    377      1.36  sborrill 		dir_n = pos;
    378      1.36  sborrill 	}
    379      1.36  sborrill 
    380      1.36  sborrill 	for (pos = 0; pos < dir_n; pos++) {
    381      1.30    cegger 		err = 0;
    382      1.36  sborrill 		if (lookup)
    383      1.36  sborrill 			i = lookup[pos];
    384      1.36  sborrill 		else
    385      1.36  sborrill 			i = pos;
    386       1.5    bouyer 		/*
    387       1.5    bouyer 		 * add size of path to size of xenbus_device. xenbus_device
    388       1.5    bouyer 		 * already has room for one char in xbusd_path.
    389       1.5    bouyer 		 */
    390      1.11    bouyer 		msize = sizeof(*xbusd) + strlen(path) + strlen(dir[i]) + 2;
    391      1.45  jdolecek 		xbusd = kmem_zalloc(msize, KM_SLEEP);
    392      1.45  jdolecek 		xbusd->xbusd_sz = msize;
    393      1.49  jdolecek 		xbusd->xbusd_dmat = xenbus_dmat;
    394      1.45  jdolecek 
    395       1.2    bouyer 		snprintf(__UNCONST(xbusd->xbusd_path),
    396      1.11    bouyer 		    msize - sizeof(*xbusd) + 1, "%s/%s", path, dir[i]);
    397       1.5    bouyer 		if (xenbus_lookup_device_path(xbusd->xbusd_path) != NULL) {
    398       1.5    bouyer 			/* device already registered */
    399      1.45  jdolecek 			kmem_free(xbusd, xbusd->xbusd_sz);
    400       1.5    bouyer 			continue;
    401       1.5    bouyer 		}
    402      1.11    bouyer 		err = xenbus_read_ul(NULL, xbusd->xbusd_path, "state",
    403      1.12    bouyer 		    &state, 10);
    404      1.11    bouyer 		if (err) {
    405      1.51    bouyer 			aprint_error_dev(xenbus_dev, "can't get state "
    406      1.11    bouyer 			    "for %s (%d)\n", xbusd->xbusd_path, err);
    407      1.45  jdolecek 			kmem_free(xbusd, xbusd->xbusd_sz);
    408      1.31    cegger 			err = 0;
    409      1.11    bouyer 			continue;
    410      1.11    bouyer 		}
    411      1.11    bouyer 		if (state != XenbusStateInitialising) {
    412      1.11    bouyer 			/* device is not new */
    413      1.45  jdolecek 			kmem_free(xbusd, xbusd->xbusd_sz);
    414      1.11    bouyer 			continue;
    415      1.11    bouyer 		}
    416       1.5    bouyer 
    417       1.3    bouyer 		xbusd->xbusd_otherend_watch.xbw_dev = xbusd;
    418       1.2    bouyer 		DPRINTK("xenbus_probe_device_type probe %s\n",
    419       1.2    bouyer 		    xbusd->xbusd_path);
    420      1.11    bouyer 		if (create != NULL) {
    421      1.11    bouyer 			xbusd->xbusd_type = XENBUS_BACKEND_DEVICE;
    422      1.11    bouyer 			err = read_frontend_details(xbusd);
    423      1.11    bouyer 			if (err != 0) {
    424      1.51    bouyer 				aprint_error_dev(xenbus_dev,
    425      1.51    bouyer 				    "can't get frontend details for %s (%d)\n",
    426      1.51    bouyer 				    xbusd->xbusd_path, err);
    427      1.11    bouyer 				break;
    428      1.11    bouyer 			}
    429      1.11    bouyer 			if (create(xbusd)) {
    430      1.45  jdolecek 				kmem_free(xbusd, xbusd->xbusd_sz);
    431      1.11    bouyer 				continue;
    432      1.11    bouyer 			}
    433      1.11    bouyer 		} else {
    434      1.11    bouyer 			xbusd->xbusd_type = XENBUS_FRONTEND_DEVICE;
    435      1.11    bouyer 			xa.xa_xbusd = xbusd;
    436      1.11    bouyer 			xa.xa_type = type;
    437      1.11    bouyer 			xa.xa_id = strtoul(dir[i], &ep, 0);
    438      1.11    bouyer 			if (dir[i][0] == '\0' || *ep != '\0') {
    439      1.51    bouyer 				aprint_error_dev(xenbus_dev,
    440      1.51    bouyer 				    "device type %s: id %s is not a number\n",
    441      1.51    bouyer 				    type, dir[i]);
    442      1.11    bouyer 				err = EFTYPE;
    443      1.45  jdolecek 				kmem_free(xbusd, xbusd->xbusd_sz);
    444      1.11    bouyer 				break;
    445      1.11    bouyer 			}
    446      1.51    bouyer 			if (strcmp(xa.xa_type, "vbd") == 0) {
    447      1.51    bouyer 				char dtype[10];
    448      1.51    bouyer 				if (xenbus_read(NULL, xbusd->xbusd_path,
    449      1.51    bouyer 				    "device-type", dtype, sizeof(dtype)) !=0) {
    450      1.51    bouyer 					aprint_error_dev(xenbus_dev,
    451      1.51    bouyer 					    "%s: can't read device-type\n",
    452      1.51    bouyer 					    xbusd->xbusd_path);
    453      1.51    bouyer 					kmem_free(xbusd, xbusd->xbusd_sz);
    454      1.51    bouyer 					break;
    455      1.51    bouyer 				}
    456  1.58.6.2    martin 				if (vm_guest == VM_GUEST_XENPVHVM &&
    457  1.58.6.2    martin 				    strcmp(dtype, "cdrom") == 0) {
    458      1.51    bouyer 					aprint_verbose_dev(xenbus_dev,
    459      1.51    bouyer 					    "ignoring %s type cdrom\n",
    460      1.51    bouyer 					    xbusd->xbusd_path);
    461      1.51    bouyer 					kmem_free(xbusd, xbusd->xbusd_sz);
    462      1.51    bouyer 					continue;
    463      1.51    bouyer 				}
    464      1.51    bouyer 			}
    465      1.11    bouyer 			err = read_backend_details(xbusd);
    466      1.11    bouyer 			if (err != 0) {
    467      1.51    bouyer 				aprint_error_dev(xenbus_dev,
    468      1.51    bouyer 				    "can't get backend details for %s (%d)\n",
    469      1.51    bouyer 				    xbusd->xbusd_path, err);
    470      1.45  jdolecek 				kmem_free(xbusd, xbusd->xbusd_sz);
    471      1.11    bouyer 				break;
    472      1.11    bouyer 			}
    473      1.57    bouyer 
    474      1.57    bouyer 			KERNEL_LOCK(1, curlwp);
    475      1.56   thorpej 			xbusd->xbusd_u.f.f_dev = config_found(xenbus_dev,
    476      1.58   thorpej 			    &xa, xenbus_print, CFARGS_NONE);
    477      1.57    bouyer 			KERNEL_UNLOCK_ONE(curlwp);
    478      1.11    bouyer 			if (xbusd->xbusd_u.f.f_dev == NULL) {
    479      1.45  jdolecek 				kmem_free(xbusd, xbusd->xbusd_sz);
    480      1.11    bouyer 				continue;
    481      1.11    bouyer 			}
    482       1.3    bouyer 		}
    483      1.11    bouyer 		SLIST_INSERT_HEAD(&xenbus_device_list,
    484      1.11    bouyer 		    xbusd, xbusd_entries);
    485      1.29       jym 		watch_otherend(xbusd);
    486       1.1    bouyer 	}
    487      1.46  jdolecek 	xenbus_directory_free(orig_dir_n, dir);
    488      1.36  sborrill 	if (lookup)
    489      1.45  jdolecek 		kmem_free(lookup, lookup_sz);
    490      1.36  sborrill 
    491       1.1    bouyer 	return err;
    492       1.1    bouyer }
    493       1.1    bouyer 
    494       1.2    bouyer static int
    495       1.2    bouyer xenbus_print(void *aux, const char *pnp)
    496       1.2    bouyer {
    497       1.2    bouyer 	struct xenbusdev_attach_args *xa = aux;
    498       1.2    bouyer 
    499       1.2    bouyer 	if (pnp) {
    500       1.2    bouyer 		if (strcmp(xa->xa_type, "vbd") == 0)
    501       1.2    bouyer 			aprint_normal("xbd");
    502       1.2    bouyer 		else if (strcmp(xa->xa_type, "vif") == 0)
    503       1.2    bouyer 			aprint_normal("xennet");
    504      1.32       jym 		else if (strcmp(xa->xa_type, "balloon") == 0)
    505      1.32       jym 			aprint_normal("balloon");
    506       1.2    bouyer 		else
    507       1.2    bouyer 			aprint_normal("unknown type %s", xa->xa_type);
    508       1.2    bouyer 		aprint_normal(" at %s", pnp);
    509       1.2    bouyer 	}
    510       1.2    bouyer 	aprint_normal(" id %d", xa->xa_id);
    511       1.2    bouyer 	return(UNCONF);
    512       1.2    bouyer }
    513       1.2    bouyer 
    514       1.2    bouyer static int
    515      1.11    bouyer xenbus_probe_frontends(void)
    516       1.1    bouyer {
    517       1.2    bouyer 	int err;
    518       1.1    bouyer 	char **dir;
    519       1.1    bouyer 	unsigned int i, dir_n;
    520      1.11    bouyer 	char path[30];
    521       1.1    bouyer 
    522      1.11    bouyer 	DPRINTK("probe device");
    523      1.11    bouyer 	err = xenbus_directory(NULL, "device", "", &dir_n, &dir);
    524       1.2    bouyer 	DPRINTK("directory err %d dir_n %d", err, dir_n);
    525       1.2    bouyer 	if (err)
    526       1.2    bouyer 		return err;
    527       1.1    bouyer 
    528       1.1    bouyer 	for (i = 0; i < dir_n; i++) {
    529      1.27       jym 		/*
    530      1.27       jym 		 * console is configured through xen_start_info when
    531      1.27       jym 		 * xencons is attaching to hypervisor, so avoid console
    532      1.27       jym 		 * probing when configuring xenbus devices
    533      1.27       jym 		 */
    534      1.27       jym 		if (strcmp(dir[i], "console") == 0)
    535      1.27       jym 			continue;
    536      1.27       jym 
    537      1.11    bouyer 		snprintf(path, sizeof(path), "device/%s", dir[i]);
    538      1.11    bouyer 		err = xenbus_probe_device_type(path, dir[i], NULL);
    539       1.1    bouyer 		if (err)
    540       1.1    bouyer 			break;
    541       1.1    bouyer 	}
    542      1.46  jdolecek 	xenbus_directory_free(dir_n, dir);
    543       1.1    bouyer 	return err;
    544       1.1    bouyer }
    545       1.1    bouyer 
    546      1.11    bouyer static int
    547      1.11    bouyer xenbus_probe_backends(void)
    548      1.11    bouyer {
    549      1.11    bouyer 	int err;
    550      1.11    bouyer 	char **dirt, **dirid;
    551      1.11    bouyer 	unsigned int type, id, dirt_n, dirid_n;
    552      1.11    bouyer 	char path[30];
    553      1.11    bouyer 	struct xenbus_backend_driver *xbakd;
    554      1.11    bouyer 
    555      1.11    bouyer 	DPRINTK("probe backend");
    556      1.11    bouyer 	err = xenbus_directory(NULL, "backend", "", &dirt_n, &dirt);
    557      1.11    bouyer 	DPRINTK("directory err %d dirt_n %d", err, dirt_n);
    558      1.11    bouyer 	if (err)
    559      1.11    bouyer 		return err;
    560      1.11    bouyer 
    561      1.11    bouyer 	for (type = 0; type < dirt_n; type++) {
    562      1.11    bouyer 		SLIST_FOREACH(xbakd, &xenbus_backend_driver_list,
    563      1.11    bouyer 		    xbakd_entries) {
    564      1.11    bouyer 			if (strcmp(dirt[type], xbakd->xbakd_type) == 0)
    565      1.11    bouyer 				break;
    566      1.11    bouyer 		}
    567      1.11    bouyer 		if (xbakd == NULL)
    568      1.11    bouyer 			continue;
    569      1.11    bouyer 		err = xenbus_directory(NULL, "backend", dirt[type],
    570      1.11    bouyer 		    &dirid_n, &dirid);
    571      1.11    bouyer 		DPRINTK("directory backend/%s err %d dirid_n %d",
    572      1.11    bouyer 		    dirt[type], err, dirid_n);
    573      1.46  jdolecek 		if (err)
    574      1.46  jdolecek 			goto out;
    575      1.46  jdolecek 
    576      1.11    bouyer 		for (id = 0; id < dirid_n; id++) {
    577      1.11    bouyer 			snprintf(path, sizeof(path), "backend/%s/%s",
    578      1.11    bouyer 			    dirt[type], dirid[id]);
    579      1.11    bouyer 			err = xenbus_probe_device_type(path, dirt[type],
    580      1.11    bouyer 			    xbakd->xbakd_create);
    581      1.11    bouyer 			if (err)
    582      1.11    bouyer 				break;
    583      1.11    bouyer 		}
    584      1.46  jdolecek 		xenbus_directory_free(dirid_n, dirid);
    585      1.11    bouyer 	}
    586      1.46  jdolecek 
    587      1.46  jdolecek out:
    588      1.46  jdolecek 	xenbus_directory_free(dirt_n, dirt);
    589      1.11    bouyer 	return err;
    590      1.11    bouyer }
    591      1.11    bouyer 
    592       1.5    bouyer int
    593       1.5    bouyer xenbus_free_device(struct xenbus_device *xbusd)
    594       1.5    bouyer {
    595       1.5    bouyer 	KASSERT(xenbus_lookup_device_path(xbusd->xbusd_path) == xbusd);
    596       1.5    bouyer 	SLIST_REMOVE(&xenbus_device_list, xbusd, xenbus_device, xbusd_entries);
    597       1.5    bouyer 	free_otherend_watch(xbusd);
    598      1.29       jym 	free_otherend_details(xbusd);
    599       1.5    bouyer 	xenbus_switch_state(xbusd, NULL, XenbusStateClosed);
    600      1.45  jdolecek 	kmem_free(xbusd, xbusd->xbusd_sz);
    601       1.5    bouyer 	return 0;
    602       1.5    bouyer }
    603       1.5    bouyer 
    604       1.2    bouyer static void
    605       1.2    bouyer frontend_changed(struct xenbus_watch *watch,
    606       1.1    bouyer 			     const char **vec, unsigned int len)
    607       1.1    bouyer {
    608      1.11    bouyer 	DPRINTK("frontend_changed %s\n", vec[XS_WATCH_PATH]);
    609      1.11    bouyer 	xenbus_probe_frontends();
    610       1.1    bouyer }
    611       1.1    bouyer 
    612       1.2    bouyer static void
    613       1.2    bouyer backend_changed(struct xenbus_watch *watch,
    614       1.1    bouyer 			    const char **vec, unsigned int len)
    615       1.1    bouyer {
    616      1.11    bouyer 	DPRINTK("backend_changed %s\n", vec[XS_WATCH_PATH]);
    617      1.11    bouyer 	xenbus_probe_backends();
    618       1.1    bouyer }
    619       1.1    bouyer 
    620       1.2    bouyer 
    621       1.1    bouyer /* We watch for devices appearing and vanishing. */
    622       1.3    bouyer static struct xenbus_watch fe_watch;
    623       1.1    bouyer 
    624       1.3    bouyer static struct xenbus_watch be_watch;
    625       1.1    bouyer 
    626       1.1    bouyer /* A flag to determine if xenstored is 'ready' (i.e. has started) */
    627      1.39   msaitoh int xenstored_ready = 0;
    628      1.52    bouyer static kmutex_t xenstored_lock;
    629      1.52    bouyer static kcondvar_t xenstored_cv;
    630       1.1    bouyer 
    631       1.2    bouyer void
    632       1.2    bouyer xenbus_probe(void *unused)
    633       1.1    bouyer {
    634      1.32       jym 	struct xenbusdev_attach_args balloon_xa = {
    635      1.32       jym 		.xa_id = 0,
    636      1.32       jym 		.xa_type = "balloon"
    637      1.32       jym 	};
    638      1.32       jym 
    639      1.39   msaitoh 	KASSERT((xenstored_ready > 0));
    640       1.1    bouyer 
    641       1.1    bouyer 	/* Enumerate devices in xenstore. */
    642      1.11    bouyer 	xenbus_probe_frontends();
    643      1.11    bouyer 	xenbus_probe_backends();
    644       1.1    bouyer 
    645       1.1    bouyer 	/* Watch for changes. */
    646      1.44  jdolecek 	fe_watch.node_sz = strlen("device") + 1;
    647      1.44  jdolecek 	fe_watch.node = kmem_alloc(fe_watch.node_sz, KM_SLEEP);
    648      1.43  jdolecek 	strcpy(fe_watch.node, "device");
    649       1.3    bouyer 	fe_watch.xbw_callback = frontend_changed;
    650       1.1    bouyer 	register_xenbus_watch(&fe_watch);
    651      1.44  jdolecek 
    652      1.44  jdolecek 	be_watch.node_sz = strlen("backend") + 1;
    653      1.44  jdolecek 	be_watch.node = kmem_alloc(be_watch.node_sz, KM_SLEEP);
    654      1.43  jdolecek 	strcpy(be_watch.node, "backend");
    655       1.3    bouyer 	be_watch.xbw_callback = backend_changed;
    656       1.1    bouyer 	register_xenbus_watch(&be_watch);
    657      1.32       jym 
    658      1.32       jym 	/* attach balloon. */
    659      1.57    bouyer 	KERNEL_LOCK(1, curlwp);
    660      1.56   thorpej 	config_found(xenbus_dev, &balloon_xa, xenbus_print,
    661      1.58   thorpej 	    CFARGS_NONE);
    662      1.57    bouyer 	KERNEL_UNLOCK_ONE(curlwp);
    663      1.32       jym 
    664      1.13      yamt 	shutdown_xenbus_setup();
    665       1.1    bouyer 
    666       1.1    bouyer 	/* Notify others that xenstore is up */
    667       1.2    bouyer 	//notifier_call_chain(&xenstore_chain, 0, NULL);
    668       1.1    bouyer }
    669       1.1    bouyer 
    670      1.52    bouyer void
    671      1.52    bouyer xb_xenstored_make_ready(void)
    672      1.52    bouyer {
    673      1.52    bouyer 	mutex_enter(&xenstored_lock);
    674      1.52    bouyer 	xenstored_ready = 1;
    675      1.52    bouyer 	cv_broadcast(&xenstored_cv);
    676      1.52    bouyer 	mutex_exit(&xenstored_lock);
    677      1.52    bouyer }
    678      1.52    bouyer 
    679       1.2    bouyer static void
    680       1.2    bouyer xenbus_probe_init(void *unused)
    681       1.1    bouyer {
    682      1.23    cegger 	int err = 0;
    683      1.23    cegger 	bool dom0;
    684      1.23    cegger 	vaddr_t page = 0;
    685       1.1    bouyer 
    686       1.1    bouyer 	DPRINTK("");
    687       1.1    bouyer 
    688       1.5    bouyer 	SLIST_INIT(&xenbus_device_list);
    689      1.52    bouyer 	mutex_init(&xenstored_lock, MUTEX_DEFAULT, IPL_TTY);
    690      1.52    bouyer 	cv_init(&xenstored_cv, "xsready");
    691       1.5    bouyer 
    692       1.1    bouyer 	/*
    693       1.1    bouyer 	** Domain0 doesn't have a store_evtchn or store_mfn yet.
    694       1.1    bouyer 	*/
    695      1.23    cegger 	dom0 = xendomain_is_dom0();
    696       1.1    bouyer 	if (dom0) {
    697       1.7    bouyer #if defined(DOM0OPS)
    698       1.7    bouyer 		paddr_t ma;
    699      1.22      tron 		evtchn_op_t op = { .cmd = 0 };
    700       1.1    bouyer 
    701       1.1    bouyer 		/* Allocate page. */
    702       1.7    bouyer 		page = uvm_km_alloc(kernel_map, PAGE_SIZE, 0,
    703       1.7    bouyer 		    UVM_KMF_ZERO | UVM_KMF_WIRED);
    704       1.1    bouyer 		if (!page)
    705       1.7    bouyer 			panic("can't get xenstore page");
    706       1.1    bouyer 
    707       1.7    bouyer 		(void)pmap_extract_ma(pmap_kernel(), page, &ma);
    708       1.7    bouyer 		xen_start_info.store_mfn = ma >> PAGE_SHIFT;
    709       1.7    bouyer 		xenstore_interface = (void *)page;
    710       1.1    bouyer 
    711       1.1    bouyer 		/* Next allocate a local port which xenstored can bind to */
    712       1.1    bouyer 		op.cmd = EVTCHNOP_alloc_unbound;
    713       1.1    bouyer 		op.u.alloc_unbound.dom        = DOMID_SELF;
    714      1.39   msaitoh 		op.u.alloc_unbound.remote_dom = 0;
    715       1.1    bouyer 
    716      1.23    cegger 		err = HYPERVISOR_event_channel_op(&op);
    717      1.23    cegger 		if (err) {
    718      1.24    cegger 			aprint_error_dev(xenbus_dev,
    719      1.23    cegger 				"can't register xenstore event\n");
    720      1.23    cegger 			goto err0;
    721      1.23    cegger 		}
    722      1.23    cegger 
    723       1.7    bouyer 		xen_start_info.store_evtchn = op.u.alloc_unbound.port;
    724       1.1    bouyer 
    725      1.21    cegger 		DELAY(1000);
    726       1.7    bouyer #else /* DOM0OPS */
    727  1.58.6.1    martin 		panic("dom0 support not compiled in");
    728       1.7    bouyer #endif /* DOM0OPS */
    729       1.1    bouyer 	}
    730       1.1    bouyer 
    731      1.55    bouyer #if NKERNFS > 0
    732      1.35       jym 	/* Publish xenbus and Xenstore info in /kern/xen */
    733      1.35       jym 	xenbus_kernfs_init();
    734      1.55    bouyer #endif
    735      1.35       jym 
    736      1.10    bouyer 	/* register event handler */
    737      1.24    cegger 	xb_init_comms(xenbus_dev);
    738      1.10    bouyer 
    739       1.1    bouyer 	/* Initialize the interface to xenstore. */
    740      1.39   msaitoh 	err = xs_init(xenbus_dev);
    741       1.1    bouyer 	if (err) {
    742      1.24    cegger 		aprint_error_dev(xenbus_dev,
    743      1.39   msaitoh 		    "Error initializing xenstore comms: %i\n", err);
    744      1.23    cegger 		goto err0;
    745       1.1    bouyer 	}
    746       1.1    bouyer 
    747       1.1    bouyer 	if (!dom0) {
    748       1.1    bouyer 		xenstored_ready = 1;
    749       1.1    bouyer 		xenbus_probe(NULL);
    750       1.1    bouyer 	}
    751       1.1    bouyer 
    752       1.2    bouyer 	DPRINTK("done");
    753      1.38       riz 	config_pending_decr(xenbus_dev);
    754      1.11    bouyer #ifdef DOM0OPS
    755      1.11    bouyer 	if (dom0) {
    756      1.52    bouyer 		mutex_enter(&xenstored_lock);
    757      1.11    bouyer 		while (xenstored_ready == 0) {
    758      1.52    bouyer 			cv_wait(&xenstored_cv, &xenstored_lock);
    759      1.52    bouyer 			mutex_exit(&xenstored_lock);
    760      1.11    bouyer 			xenbus_probe(NULL);
    761      1.52    bouyer 			mutex_enter(&xenstored_lock);
    762      1.11    bouyer 		}
    763      1.52    bouyer 		mutex_exit(&xenstored_lock);
    764      1.11    bouyer 	}
    765      1.11    bouyer #endif
    766       1.2    bouyer 	kthread_exit(0);
    767      1.23    cegger 
    768      1.23    cegger err0:
    769      1.23    cegger 	if (page)
    770      1.23    cegger 		uvm_km_free(kernel_map, page, PAGE_SIZE,
    771      1.23    cegger 				UVM_KMF_ZERO | UVM_KMF_WIRED);
    772      1.23    cegger 	kthread_exit(err);
    773       1.1    bouyer }
    774       1.1    bouyer 
    775       1.1    bouyer /*
    776       1.1    bouyer  * Local variables:
    777       1.1    bouyer  *  c-file-style: "linux"
    778       1.1    bouyer  *  indent-tabs-mode: t
    779       1.1    bouyer  *  c-indent-level: 8
    780       1.1    bouyer  *  c-basic-offset: 8
    781       1.1    bouyer  *  tab-width: 8
    782       1.1    bouyer  * End:
    783       1.1    bouyer  */
    784