1 // SPDX-License-Identifier: GPL-2.0-only
3 * linux/fs/9p/trans_xen
7 * Copyright (C) 2017 by Stefano Stabellini <stefano@aporeto.com>
10 #include <xen/events.h>
11 #include <xen/grant_table.h>
13 #include <xen/xenbus.h>
14 #include <xen/interface/io/9pfs.h>
16 #include <linux/module.h>
17 #include <linux/spinlock.h>
18 #include <net/9p/9p.h>
19 #include <net/9p/client.h>
20 #include <net/9p/transport.h>
22 #define XEN_9PFS_NUM_RINGS 2
23 #define XEN_9PFS_RING_ORDER 9
24 #define XEN_9PFS_RING_SIZE(ring) XEN_FLEX_RING_SIZE(ring->intf->ring_order)
26 struct xen_9pfs_header {
31 /* uint8_t sdata[]; */
32 } __attribute__((packed));
34 /* One per ring, more than one per 9pfs share */
35 struct xen_9pfs_dataring {
36 struct xen_9pfs_front_priv *priv;
38 struct xen_9pfs_data_intf *intf;
42 /* protect a ring from concurrent accesses */
45 struct xen_9pfs_data data;
47 struct work_struct work;
50 /* One per 9pfs share */
51 struct xen_9pfs_front_priv {
52 struct list_head list;
53 struct xenbus_device *dev;
55 struct p9_client *client;
58 struct xen_9pfs_dataring *rings;
61 static LIST_HEAD(xen_9pfs_devs);
62 static DEFINE_RWLOCK(xen_9pfs_lock);
64 /* We don't currently allow canceling of requests */
65 static int p9_xen_cancel(struct p9_client *client, struct p9_req_t *req)
70 static int p9_xen_create(struct p9_client *client, const char *addr, char *args)
72 struct xen_9pfs_front_priv *priv;
77 read_lock(&xen_9pfs_lock);
78 list_for_each_entry(priv, &xen_9pfs_devs, list) {
79 if (!strcmp(priv->tag, addr)) {
80 priv->client = client;
81 read_unlock(&xen_9pfs_lock);
85 read_unlock(&xen_9pfs_lock);
89 static void p9_xen_close(struct p9_client *client)
91 struct xen_9pfs_front_priv *priv;
93 read_lock(&xen_9pfs_lock);
94 list_for_each_entry(priv, &xen_9pfs_devs, list) {
95 if (priv->client == client) {
97 read_unlock(&xen_9pfs_lock);
101 read_unlock(&xen_9pfs_lock);
104 static bool p9_xen_write_todo(struct xen_9pfs_dataring *ring, RING_IDX size)
108 cons = ring->intf->out_cons;
109 prod = ring->intf->out_prod;
112 return XEN_9PFS_RING_SIZE(ring) -
113 xen_9pfs_queued(prod, cons, XEN_9PFS_RING_SIZE(ring)) >= size;
116 static int p9_xen_request(struct p9_client *client, struct p9_req_t *p9_req)
118 struct xen_9pfs_front_priv *priv;
119 RING_IDX cons, prod, masked_cons, masked_prod;
121 u32 size = p9_req->tc.size;
122 struct xen_9pfs_dataring *ring;
125 read_lock(&xen_9pfs_lock);
126 list_for_each_entry(priv, &xen_9pfs_devs, list) {
127 if (priv->client == client)
130 read_unlock(&xen_9pfs_lock);
131 if (list_entry_is_head(priv, &xen_9pfs_devs, list))
134 num = p9_req->tc.tag % priv->num_rings;
135 ring = &priv->rings[num];
138 while (wait_event_killable(ring->wq,
139 p9_xen_write_todo(ring, size)) != 0)
142 spin_lock_irqsave(&ring->lock, flags);
143 cons = ring->intf->out_cons;
144 prod = ring->intf->out_prod;
147 if (XEN_9PFS_RING_SIZE(ring) -
148 xen_9pfs_queued(prod, cons, XEN_9PFS_RING_SIZE(ring)) < size) {
149 spin_unlock_irqrestore(&ring->lock, flags);
153 masked_prod = xen_9pfs_mask(prod, XEN_9PFS_RING_SIZE(ring));
154 masked_cons = xen_9pfs_mask(cons, XEN_9PFS_RING_SIZE(ring));
156 xen_9pfs_write_packet(ring->data.out, p9_req->tc.sdata, size,
157 &masked_prod, masked_cons,
158 XEN_9PFS_RING_SIZE(ring));
160 p9_req->status = REQ_STATUS_SENT;
161 virt_wmb(); /* write ring before updating pointer */
163 ring->intf->out_prod = prod;
164 spin_unlock_irqrestore(&ring->lock, flags);
165 notify_remote_via_irq(ring->irq);
171 static void p9_xen_response(struct work_struct *work)
173 struct xen_9pfs_front_priv *priv;
174 struct xen_9pfs_dataring *ring;
175 RING_IDX cons, prod, masked_cons, masked_prod;
176 struct xen_9pfs_header h;
177 struct p9_req_t *req;
180 ring = container_of(work, struct xen_9pfs_dataring, work);
184 cons = ring->intf->in_cons;
185 prod = ring->intf->in_prod;
188 if (xen_9pfs_queued(prod, cons, XEN_9PFS_RING_SIZE(ring)) <
190 notify_remote_via_irq(ring->irq);
194 masked_prod = xen_9pfs_mask(prod, XEN_9PFS_RING_SIZE(ring));
195 masked_cons = xen_9pfs_mask(cons, XEN_9PFS_RING_SIZE(ring));
197 /* First, read just the header */
198 xen_9pfs_read_packet(&h, ring->data.in, sizeof(h),
199 masked_prod, &masked_cons,
200 XEN_9PFS_RING_SIZE(ring));
202 req = p9_tag_lookup(priv->client, h.tag);
203 if (!req || req->status != REQ_STATUS_SENT) {
204 dev_warn(&priv->dev->dev, "Wrong req tag=%x\n", h.tag);
207 ring->intf->in_cons = cons;
211 memcpy(&req->rc, &h, sizeof(h));
214 masked_cons = xen_9pfs_mask(cons, XEN_9PFS_RING_SIZE(ring));
215 /* Then, read the whole packet (including the header) */
216 xen_9pfs_read_packet(req->rc.sdata, ring->data.in, h.size,
217 masked_prod, &masked_cons,
218 XEN_9PFS_RING_SIZE(ring));
222 ring->intf->in_cons = cons;
224 status = (req->status != REQ_STATUS_ERROR) ?
225 REQ_STATUS_RCVD : REQ_STATUS_ERROR;
227 p9_client_cb(priv->client, req, status);
231 static irqreturn_t xen_9pfs_front_event_handler(int irq, void *r)
233 struct xen_9pfs_dataring *ring = r;
235 if (!ring || !ring->priv->client) {
236 /* ignore spurious interrupt */
240 wake_up_interruptible(&ring->wq);
241 schedule_work(&ring->work);
246 static struct p9_trans_module p9_xen_trans = {
248 .maxsize = 1 << (XEN_9PFS_RING_ORDER + XEN_PAGE_SHIFT - 2),
250 .create = p9_xen_create,
251 .close = p9_xen_close,
252 .request = p9_xen_request,
253 .cancel = p9_xen_cancel,
254 .owner = THIS_MODULE,
257 static const struct xenbus_device_id xen_9pfs_front_ids[] = {
262 static void xen_9pfs_front_free(struct xen_9pfs_front_priv *priv)
266 write_lock(&xen_9pfs_lock);
267 list_del(&priv->list);
268 write_unlock(&xen_9pfs_lock);
270 for (i = 0; i < priv->num_rings; i++) {
271 if (!priv->rings[i].intf)
273 if (priv->rings[i].irq > 0)
274 unbind_from_irqhandler(priv->rings[i].irq, priv->dev);
275 if (priv->rings[i].data.in) {
277 j < (1 << priv->rings[i].intf->ring_order);
281 ref = priv->rings[i].intf->ref[j];
282 gnttab_end_foreign_access(ref, 0, 0);
284 free_pages_exact(priv->rings[i].data.in,
285 1UL << (priv->rings[i].intf->ring_order +
288 gnttab_end_foreign_access(priv->rings[i].ref, 0, 0);
289 free_page((unsigned long)priv->rings[i].intf);
296 static int xen_9pfs_front_remove(struct xenbus_device *dev)
298 struct xen_9pfs_front_priv *priv = dev_get_drvdata(&dev->dev);
300 dev_set_drvdata(&dev->dev, NULL);
301 xen_9pfs_front_free(priv);
305 static int xen_9pfs_front_alloc_dataring(struct xenbus_device *dev,
306 struct xen_9pfs_dataring *ring,
313 init_waitqueue_head(&ring->wq);
314 spin_lock_init(&ring->lock);
315 INIT_WORK(&ring->work, p9_xen_response);
317 ring->intf = (struct xen_9pfs_data_intf *)get_zeroed_page(GFP_KERNEL);
320 ret = gnttab_grant_foreign_access(dev->otherend_id,
321 virt_to_gfn(ring->intf), 0);
325 bytes = alloc_pages_exact(1UL << (order + XEN_PAGE_SHIFT),
326 GFP_KERNEL | __GFP_ZERO);
331 for (; i < (1 << order); i++) {
332 ret = gnttab_grant_foreign_access(
333 dev->otherend_id, virt_to_gfn(bytes) + i, 0);
336 ring->intf->ref[i] = ret;
338 ring->intf->ring_order = order;
339 ring->data.in = bytes;
340 ring->data.out = bytes + XEN_FLEX_RING_SIZE(order);
342 ret = xenbus_alloc_evtchn(dev, &ring->evtchn);
345 ring->irq = bind_evtchn_to_irqhandler(ring->evtchn,
346 xen_9pfs_front_event_handler,
347 0, "xen_9pfs-frontend", ring);
351 xenbus_free_evtchn(dev, ring->evtchn);
355 for (i--; i >= 0; i--)
356 gnttab_end_foreign_access(ring->intf->ref[i], 0, 0);
357 free_pages_exact(bytes, 1UL << (order + XEN_PAGE_SHIFT));
359 gnttab_end_foreign_access(ring->ref, 0, 0);
360 free_page((unsigned long)ring->intf);
364 static int xen_9pfs_front_probe(struct xenbus_device *dev,
365 const struct xenbus_device_id *id)
368 struct xenbus_transaction xbt;
369 struct xen_9pfs_front_priv *priv = NULL;
371 unsigned int max_rings, max_ring_order, len = 0;
373 versions = xenbus_read(XBT_NIL, dev->otherend, "versions", &len);
374 if (IS_ERR(versions))
375 return PTR_ERR(versions);
376 if (strcmp(versions, "1")) {
381 max_rings = xenbus_read_unsigned(dev->otherend, "max-rings", 0);
382 if (max_rings < XEN_9PFS_NUM_RINGS)
384 max_ring_order = xenbus_read_unsigned(dev->otherend,
385 "max-ring-page-order", 0);
386 if (max_ring_order > XEN_9PFS_RING_ORDER)
387 max_ring_order = XEN_9PFS_RING_ORDER;
388 if (p9_xen_trans.maxsize > XEN_FLEX_RING_SIZE(max_ring_order))
389 p9_xen_trans.maxsize = XEN_FLEX_RING_SIZE(max_ring_order) / 2;
391 priv = kzalloc(sizeof(*priv), GFP_KERNEL);
396 priv->num_rings = XEN_9PFS_NUM_RINGS;
397 priv->rings = kcalloc(priv->num_rings, sizeof(*priv->rings),
404 for (i = 0; i < priv->num_rings; i++) {
405 priv->rings[i].priv = priv;
406 ret = xen_9pfs_front_alloc_dataring(dev, &priv->rings[i],
413 ret = xenbus_transaction_start(&xbt);
415 xenbus_dev_fatal(dev, ret, "starting transaction");
418 ret = xenbus_printf(xbt, dev->nodename, "version", "%u", 1);
421 ret = xenbus_printf(xbt, dev->nodename, "num-rings", "%u",
425 for (i = 0; i < priv->num_rings; i++) {
428 BUILD_BUG_ON(XEN_9PFS_NUM_RINGS > 9);
429 sprintf(str, "ring-ref%d", i);
430 ret = xenbus_printf(xbt, dev->nodename, str, "%d",
435 sprintf(str, "event-channel-%d", i);
436 ret = xenbus_printf(xbt, dev->nodename, str, "%u",
437 priv->rings[i].evtchn);
441 priv->tag = xenbus_read(xbt, dev->nodename, "tag", NULL);
442 if (IS_ERR(priv->tag)) {
443 ret = PTR_ERR(priv->tag);
446 ret = xenbus_transaction_end(xbt, 0);
450 xenbus_dev_fatal(dev, ret, "completing transaction");
454 write_lock(&xen_9pfs_lock);
455 list_add_tail(&priv->list, &xen_9pfs_devs);
456 write_unlock(&xen_9pfs_lock);
457 dev_set_drvdata(&dev->dev, priv);
458 xenbus_switch_state(dev, XenbusStateInitialised);
463 xenbus_transaction_end(xbt, 1);
464 xenbus_dev_fatal(dev, ret, "writing xenstore");
466 dev_set_drvdata(&dev->dev, NULL);
467 xen_9pfs_front_free(priv);
471 static int xen_9pfs_front_resume(struct xenbus_device *dev)
473 dev_warn(&dev->dev, "suspend/resume unsupported\n");
477 static void xen_9pfs_front_changed(struct xenbus_device *dev,
478 enum xenbus_state backend_state)
480 switch (backend_state) {
481 case XenbusStateReconfiguring:
482 case XenbusStateReconfigured:
483 case XenbusStateInitialising:
484 case XenbusStateInitialised:
485 case XenbusStateUnknown:
488 case XenbusStateInitWait:
491 case XenbusStateConnected:
492 xenbus_switch_state(dev, XenbusStateConnected);
495 case XenbusStateClosed:
496 if (dev->state == XenbusStateClosed)
498 fallthrough; /* Missed the backend's CLOSING state */
499 case XenbusStateClosing:
500 xenbus_frontend_closed(dev);
505 static struct xenbus_driver xen_9pfs_front_driver = {
506 .ids = xen_9pfs_front_ids,
507 .probe = xen_9pfs_front_probe,
508 .remove = xen_9pfs_front_remove,
509 .resume = xen_9pfs_front_resume,
510 .otherend_changed = xen_9pfs_front_changed,
513 static int p9_trans_xen_init(void)
520 pr_info("Initialising Xen transport for 9pfs\n");
522 v9fs_register_trans(&p9_xen_trans);
523 rc = xenbus_register_frontend(&xen_9pfs_front_driver);
525 v9fs_unregister_trans(&p9_xen_trans);
529 module_init(p9_trans_xen_init);
530 MODULE_ALIAS_9P("xen");
532 static void p9_trans_xen_exit(void)
534 v9fs_unregister_trans(&p9_xen_trans);
535 return xenbus_unregister_driver(&xen_9pfs_front_driver);
537 module_exit(p9_trans_xen_exit);
539 MODULE_ALIAS("xen:9pfs");
540 MODULE_AUTHOR("Stefano Stabellini <stefano@aporeto.com>");
541 MODULE_DESCRIPTION("Xen Transport for 9P");
542 MODULE_LICENSE("GPL");