1 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
2 
3 #define DPRINTK(fmt, ...)				\
4 	pr_debug("(%s:%d) " fmt "\n",			\
5 		 __func__, __LINE__, ##__VA_ARGS__)
6 
7 #include <linux/kernel.h>
8 #include <linux/err.h>
9 #include <linux/string.h>
10 #include <linux/ctype.h>
11 #include <linux/fcntl.h>
12 #include <linux/mm.h>
13 #include <linux/proc_fs.h>
14 #include <linux/notifier.h>
15 #include <linux/kthread.h>
16 #include <linux/mutex.h>
17 #include <linux/io.h>
18 #include <linux/module.h>
19 
20 #include <asm/page.h>
21 #include <asm/pgtable.h>
22 #include <asm/xen/hypervisor.h>
23 #include <xen/xenbus.h>
24 #include <xen/events.h>
25 #include <xen/page.h>
26 #include <xen/xen.h>
27 
28 #include <xen/platform_pci.h>
29 
30 #include "xenbus_comms.h"
31 #include "xenbus_probe.h"
32 
33 
34 static struct workqueue_struct *xenbus_frontend_wq;
35 
36 /* device/<type>/<id> => <type>-<id> */
37 static int frontend_bus_id(char bus_id[XEN_BUS_ID_SIZE], const char *nodename)
38 {
39 	nodename = strchr(nodename, '/');
40 	if (!nodename || strlen(nodename + 1) >= XEN_BUS_ID_SIZE) {
41 		pr_warn("bad frontend %s\n", nodename);
42 		return -EINVAL;
43 	}
44 
45 	strlcpy(bus_id, nodename + 1, XEN_BUS_ID_SIZE);
46 	if (!strchr(bus_id, '/')) {
47 		pr_warn("bus_id %s no slash\n", bus_id);
48 		return -EINVAL;
49 	}
50 	*strchr(bus_id, '/') = '-';
51 	return 0;
52 }
53 
54 /* device/<typename>/<name> */
55 static int xenbus_probe_frontend(struct xen_bus_type *bus, const char *type,
56 				 const char *name)
57 {
58 	char *nodename;
59 	int err;
60 
61 	/* ignore console/0 */
62 	if (!strncmp(type, "console", 7) && !strncmp(name, "0", 1)) {
63 		DPRINTK("Ignoring buggy device entry console/0");
64 		return 0;
65 	}
66 
67 	nodename = kasprintf(GFP_KERNEL, "%s/%s/%s", bus->root, type, name);
68 	if (!nodename)
69 		return -ENOMEM;
70 
71 	DPRINTK("%s", nodename);
72 
73 	err = xenbus_probe_node(bus, type, nodename);
74 	kfree(nodename);
75 	return err;
76 }
77 
78 static int xenbus_uevent_frontend(struct device *_dev,
79 				  struct kobj_uevent_env *env)
80 {
81 	struct xenbus_device *dev = to_xenbus_device(_dev);
82 
83 	if (add_uevent_var(env, "MODALIAS=xen:%s", dev->devicetype))
84 		return -ENOMEM;
85 
86 	return 0;
87 }
88 
89 
90 static void backend_changed(struct xenbus_watch *watch,
91 			    const char **vec, unsigned int len)
92 {
93 	xenbus_otherend_changed(watch, vec, len, 1);
94 }
95 
96 static void xenbus_frontend_delayed_resume(struct work_struct *w)
97 {
98 	struct xenbus_device *xdev = container_of(w, struct xenbus_device, work);
99 
100 	xenbus_dev_resume(&xdev->dev);
101 }
102 
103 static int xenbus_frontend_dev_resume(struct device *dev)
104 {
105 	/*
106 	 * If xenstored is running in this domain, we cannot access the backend
107 	 * state at the moment, so we need to defer xenbus_dev_resume
108 	 */
109 	if (xen_store_domain_type == XS_LOCAL) {
110 		struct xenbus_device *xdev = to_xenbus_device(dev);
111 
112 		if (!xenbus_frontend_wq) {
113 			pr_err("%s: no workqueue to process delayed resume\n",
114 			       xdev->nodename);
115 			return -EFAULT;
116 		}
117 
118 		queue_work(xenbus_frontend_wq, &xdev->work);
119 
120 		return 0;
121 	}
122 
123 	return xenbus_dev_resume(dev);
124 }
125 
126 static int xenbus_frontend_dev_probe(struct device *dev)
127 {
128 	if (xen_store_domain_type == XS_LOCAL) {
129 		struct xenbus_device *xdev = to_xenbus_device(dev);
130 		INIT_WORK(&xdev->work, xenbus_frontend_delayed_resume);
131 	}
132 
133 	return xenbus_dev_probe(dev);
134 }
135 
136 static const struct dev_pm_ops xenbus_pm_ops = {
137 	.suspend	= xenbus_dev_suspend,
138 	.resume		= xenbus_frontend_dev_resume,
139 	.freeze		= xenbus_dev_suspend,
140 	.thaw		= xenbus_dev_cancel,
141 	.restore	= xenbus_dev_resume,
142 };
143 
144 static struct xen_bus_type xenbus_frontend = {
145 	.root = "device",
146 	.levels = 2,		/* device/type/<id> */
147 	.get_bus_id = frontend_bus_id,
148 	.probe = xenbus_probe_frontend,
149 	.otherend_changed = backend_changed,
150 	.bus = {
151 		.name		= "xen",
152 		.match		= xenbus_match,
153 		.uevent		= xenbus_uevent_frontend,
154 		.probe		= xenbus_frontend_dev_probe,
155 		.remove		= xenbus_dev_remove,
156 		.shutdown	= xenbus_dev_shutdown,
157 		.dev_groups	= xenbus_dev_groups,
158 
159 		.pm		= &xenbus_pm_ops,
160 	},
161 };
162 
163 static void frontend_changed(struct xenbus_watch *watch,
164 			     const char **vec, unsigned int len)
165 {
166 	DPRINTK("");
167 
168 	xenbus_dev_changed(vec[XS_WATCH_PATH], &xenbus_frontend);
169 }
170 
171 
172 /* We watch for devices appearing and vanishing. */
173 static struct xenbus_watch fe_watch = {
174 	.node = "device",
175 	.callback = frontend_changed,
176 };
177 
178 static int read_backend_details(struct xenbus_device *xendev)
179 {
180 	return xenbus_read_otherend_details(xendev, "backend-id", "backend");
181 }
182 
183 static int is_device_connecting(struct device *dev, void *data, bool ignore_nonessential)
184 {
185 	struct xenbus_device *xendev = to_xenbus_device(dev);
186 	struct device_driver *drv = data;
187 	struct xenbus_driver *xendrv;
188 
189 	/*
190 	 * A device with no driver will never connect. We care only about
191 	 * devices which should currently be in the process of connecting.
192 	 */
193 	if (!dev->driver)
194 		return 0;
195 
196 	/* Is this search limited to a particular driver? */
197 	if (drv && (dev->driver != drv))
198 		return 0;
199 
200 	if (ignore_nonessential) {
201 		/* With older QEMU, for PVonHVM guests the guest config files
202 		 * could contain: vfb = [ 'vnc=1, vnclisten=0.0.0.0']
203 		 * which is nonsensical as there is no PV FB (there can be
204 		 * a PVKB) running as HVM guest. */
205 
206 		if ((strncmp(xendev->nodename, "device/vkbd", 11) == 0))
207 			return 0;
208 
209 		if ((strncmp(xendev->nodename, "device/vfb", 10) == 0))
210 			return 0;
211 	}
212 	xendrv = to_xenbus_driver(dev->driver);
213 	return (xendev->state < XenbusStateConnected ||
214 		(xendev->state == XenbusStateConnected &&
215 		 xendrv->is_ready && !xendrv->is_ready(xendev)));
216 }
217 static int essential_device_connecting(struct device *dev, void *data)
218 {
219 	return is_device_connecting(dev, data, true /* ignore PV[KBB+FB] */);
220 }
221 static int non_essential_device_connecting(struct device *dev, void *data)
222 {
223 	return is_device_connecting(dev, data, false);
224 }
225 
226 static int exists_essential_connecting_device(struct device_driver *drv)
227 {
228 	return bus_for_each_dev(&xenbus_frontend.bus, NULL, drv,
229 				essential_device_connecting);
230 }
231 static int exists_non_essential_connecting_device(struct device_driver *drv)
232 {
233 	return bus_for_each_dev(&xenbus_frontend.bus, NULL, drv,
234 				non_essential_device_connecting);
235 }
236 
237 static int print_device_status(struct device *dev, void *data)
238 {
239 	struct xenbus_device *xendev = to_xenbus_device(dev);
240 	struct device_driver *drv = data;
241 
242 	/* Is this operation limited to a particular driver? */
243 	if (drv && (dev->driver != drv))
244 		return 0;
245 
246 	if (!dev->driver) {
247 		/* Information only: is this too noisy? */
248 		pr_info("Device with no driver: %s\n", xendev->nodename);
249 	} else if (xendev->state < XenbusStateConnected) {
250 		enum xenbus_state rstate = XenbusStateUnknown;
251 		if (xendev->otherend)
252 			rstate = xenbus_read_driver_state(xendev->otherend);
253 		pr_warn("Timeout connecting to device: %s (local state %d, remote state %d)\n",
254 			xendev->nodename, xendev->state, rstate);
255 	}
256 
257 	return 0;
258 }
259 
260 /* We only wait for device setup after most initcalls have run. */
261 static int ready_to_wait_for_devices;
262 
263 static bool wait_loop(unsigned long start, unsigned int max_delay,
264 		     unsigned int *seconds_waited)
265 {
266 	if (time_after(jiffies, start + (*seconds_waited+5)*HZ)) {
267 		if (!*seconds_waited)
268 			pr_warn("Waiting for devices to initialise: ");
269 		*seconds_waited += 5;
270 		pr_cont("%us...", max_delay - *seconds_waited);
271 		if (*seconds_waited == max_delay) {
272 			pr_cont("\n");
273 			return true;
274 		}
275 	}
276 
277 	schedule_timeout_interruptible(HZ/10);
278 
279 	return false;
280 }
281 /*
282  * On a 5-minute timeout, wait for all devices currently configured.  We need
283  * to do this to guarantee that the filesystems and / or network devices
284  * needed for boot are available, before we can allow the boot to proceed.
285  *
286  * This needs to be on a late_initcall, to happen after the frontend device
287  * drivers have been initialised, but before the root fs is mounted.
288  *
289  * A possible improvement here would be to have the tools add a per-device
290  * flag to the store entry, indicating whether it is needed at boot time.
291  * This would allow people who knew what they were doing to accelerate their
292  * boot slightly, but of course needs tools or manual intervention to set up
293  * those flags correctly.
294  */
295 static void wait_for_devices(struct xenbus_driver *xendrv)
296 {
297 	unsigned long start = jiffies;
298 	struct device_driver *drv = xendrv ? &xendrv->driver : NULL;
299 	unsigned int seconds_waited = 0;
300 
301 	if (!ready_to_wait_for_devices || !xen_domain())
302 		return;
303 
304 	while (exists_non_essential_connecting_device(drv))
305 		if (wait_loop(start, 30, &seconds_waited))
306 			break;
307 
308 	/* Skips PVKB and PVFB check.*/
309 	while (exists_essential_connecting_device(drv))
310 		if (wait_loop(start, 270, &seconds_waited))
311 			break;
312 
313 	if (seconds_waited)
314 		printk("\n");
315 
316 	bus_for_each_dev(&xenbus_frontend.bus, NULL, drv,
317 			 print_device_status);
318 }
319 
320 int __xenbus_register_frontend(struct xenbus_driver *drv, struct module *owner,
321 			       const char *mod_name)
322 {
323 	int ret;
324 
325 	drv->read_otherend_details = read_backend_details;
326 
327 	ret = xenbus_register_driver_common(drv, &xenbus_frontend,
328 					    owner, mod_name);
329 	if (ret)
330 		return ret;
331 
332 	/* If this driver is loaded as a module wait for devices to attach. */
333 	wait_for_devices(drv);
334 
335 	return 0;
336 }
337 EXPORT_SYMBOL_GPL(__xenbus_register_frontend);
338 
339 static DECLARE_WAIT_QUEUE_HEAD(backend_state_wq);
340 static int backend_state;
341 
342 static void xenbus_reset_backend_state_changed(struct xenbus_watch *w,
343 					const char **v, unsigned int l)
344 {
345 	xenbus_scanf(XBT_NIL, v[XS_WATCH_PATH], "", "%i", &backend_state);
346 	printk(KERN_DEBUG "XENBUS: backend %s %s\n",
347 			v[XS_WATCH_PATH], xenbus_strstate(backend_state));
348 	wake_up(&backend_state_wq);
349 }
350 
351 static void xenbus_reset_wait_for_backend(char *be, int expected)
352 {
353 	long timeout;
354 	timeout = wait_event_interruptible_timeout(backend_state_wq,
355 			backend_state == expected, 5 * HZ);
356 	if (timeout <= 0)
357 		pr_info("backend %s timed out\n", be);
358 }
359 
360 /*
361  * Reset frontend if it is in Connected or Closed state.
362  * Wait for backend to catch up.
363  * State Connected happens during kdump, Closed after kexec.
364  */
365 static void xenbus_reset_frontend(char *fe, char *be, int be_state)
366 {
367 	struct xenbus_watch be_watch;
368 
369 	printk(KERN_DEBUG "XENBUS: backend %s %s\n",
370 			be, xenbus_strstate(be_state));
371 
372 	memset(&be_watch, 0, sizeof(be_watch));
373 	be_watch.node = kasprintf(GFP_NOIO | __GFP_HIGH, "%s/state", be);
374 	if (!be_watch.node)
375 		return;
376 
377 	be_watch.callback = xenbus_reset_backend_state_changed;
378 	backend_state = XenbusStateUnknown;
379 
380 	pr_info("triggering reconnect on %s\n", be);
381 	register_xenbus_watch(&be_watch);
382 
383 	/* fall through to forward backend to state XenbusStateInitialising */
384 	switch (be_state) {
385 	case XenbusStateConnected:
386 		xenbus_printf(XBT_NIL, fe, "state", "%d", XenbusStateClosing);
387 		xenbus_reset_wait_for_backend(be, XenbusStateClosing);
388 
389 	case XenbusStateClosing:
390 		xenbus_printf(XBT_NIL, fe, "state", "%d", XenbusStateClosed);
391 		xenbus_reset_wait_for_backend(be, XenbusStateClosed);
392 
393 	case XenbusStateClosed:
394 		xenbus_printf(XBT_NIL, fe, "state", "%d", XenbusStateInitialising);
395 		xenbus_reset_wait_for_backend(be, XenbusStateInitWait);
396 	}
397 
398 	unregister_xenbus_watch(&be_watch);
399 	pr_info("reconnect done on %s\n", be);
400 	kfree(be_watch.node);
401 }
402 
403 static void xenbus_check_frontend(char *class, char *dev)
404 {
405 	int be_state, fe_state, err;
406 	char *backend, *frontend;
407 
408 	frontend = kasprintf(GFP_NOIO | __GFP_HIGH, "device/%s/%s", class, dev);
409 	if (!frontend)
410 		return;
411 
412 	err = xenbus_scanf(XBT_NIL, frontend, "state", "%i", &fe_state);
413 	if (err != 1)
414 		goto out;
415 
416 	switch (fe_state) {
417 	case XenbusStateConnected:
418 	case XenbusStateClosed:
419 		printk(KERN_DEBUG "XENBUS: frontend %s %s\n",
420 				frontend, xenbus_strstate(fe_state));
421 		backend = xenbus_read(XBT_NIL, frontend, "backend", NULL);
422 		if (!backend || IS_ERR(backend))
423 			goto out;
424 		err = xenbus_scanf(XBT_NIL, backend, "state", "%i", &be_state);
425 		if (err == 1)
426 			xenbus_reset_frontend(frontend, backend, be_state);
427 		kfree(backend);
428 		break;
429 	default:
430 		break;
431 	}
432 out:
433 	kfree(frontend);
434 }
435 
436 static void xenbus_reset_state(void)
437 {
438 	char **devclass, **dev;
439 	int devclass_n, dev_n;
440 	int i, j;
441 
442 	devclass = xenbus_directory(XBT_NIL, "device", "", &devclass_n);
443 	if (IS_ERR(devclass))
444 		return;
445 
446 	for (i = 0; i < devclass_n; i++) {
447 		dev = xenbus_directory(XBT_NIL, "device", devclass[i], &dev_n);
448 		if (IS_ERR(dev))
449 			continue;
450 		for (j = 0; j < dev_n; j++)
451 			xenbus_check_frontend(devclass[i], dev[j]);
452 		kfree(dev);
453 	}
454 	kfree(devclass);
455 }
456 
457 static int frontend_probe_and_watch(struct notifier_block *notifier,
458 				   unsigned long event,
459 				   void *data)
460 {
461 	/* reset devices in Connected or Closed state */
462 	if (xen_hvm_domain())
463 		xenbus_reset_state();
464 	/* Enumerate devices in xenstore and watch for changes. */
465 	xenbus_probe_devices(&xenbus_frontend);
466 	register_xenbus_watch(&fe_watch);
467 
468 	return NOTIFY_DONE;
469 }
470 
471 
472 static int __init xenbus_probe_frontend_init(void)
473 {
474 	static struct notifier_block xenstore_notifier = {
475 		.notifier_call = frontend_probe_and_watch
476 	};
477 	int err;
478 
479 	DPRINTK("");
480 
481 	/* Register ourselves with the kernel bus subsystem */
482 	err = bus_register(&xenbus_frontend.bus);
483 	if (err)
484 		return err;
485 
486 	register_xenstore_notifier(&xenstore_notifier);
487 
488 	if (xen_store_domain_type == XS_LOCAL) {
489 		xenbus_frontend_wq = create_workqueue("xenbus_frontend");
490 		if (!xenbus_frontend_wq)
491 			pr_warn("create xenbus frontend workqueue failed, S3 resume is likely to fail\n");
492 	}
493 
494 	return 0;
495 }
496 subsys_initcall(xenbus_probe_frontend_init);
497 
498 #ifndef MODULE
499 static int __init boot_wait_for_devices(void)
500 {
501 	if (!xen_has_pv_devices())
502 		return -ENODEV;
503 
504 	ready_to_wait_for_devices = 1;
505 	wait_for_devices(NULL);
506 	return 0;
507 }
508 
509 late_initcall(boot_wait_for_devices);
510 #endif
511 
512 MODULE_LICENSE("GPL");
513