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