net/9p/trans_virtio.c

   1 /*
   2  * The Virtio 9p transport driver
   3  *
   4  * This is a block based transport driver based on the lguest block driver
   5  * code.
   6  *
   7  *  Copyright (C) 2007, 2008 Eric Van Hensbergen, IBM Corporation
   8  *
   9  *  Based on virtio console driver
  10  *  Copyright (C) 2006, 2007 Rusty Russell, IBM Corporation
  11  *
  12  *  This program is free software; you can redistribute it and/or modify
  13  *  it under the terms of the GNU General Public License version 2
  14  *  as published by the Free Software Foundation.
  15  *
  16  *  This program is distributed in the hope that it will be useful,
  17  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  *  GNU General Public License for more details.
  20  *
  21  *  You should have received a copy of the GNU General Public License
  22  *  along with this program; if not, write to:
  23  *  Free Software Foundation
  24  *  51 Franklin Street, Fifth Floor
  25  *  Boston, MA  02111-1301  USA
  26  *
  27  */
  28
  29 #include <linux/in.h>
  30 #include <linux/module.h>
  31 #include <linux/net.h>
  32 #include <linux/ipv6.h>
  33 #include <linux/errno.h>
  34 #include <linux/kernel.h>
  35 #include <linux/un.h>
  36 #include <linux/uaccess.h>
  37 #include <linux/inet.h>
  38 #include <linux/idr.h>
  39 #include <linux/file.h>
  40 #include <net/9p/9p.h>
  41 #include <linux/parser.h>
  42 #include <net/9p/client.h>
  43 #include <net/9p/transport.h>
  44 #include <linux/scatterlist.h>
  45 #include <linux/virtio.h>
  46 #include <linux/virtio_9p.h>
  47
  48 #define VIRTQUEUE_NUM   128
  49
  50 /* a single mutex to manage channel initialization and attachment */
  51 static DEFINE_MUTEX(virtio_9p_lock);
  52 /* global which tracks highest initialized channel */
  53 static int chan_index;
  54
  55 /**
  56  * struct virtio_chan - per-instance transport information
  57  * @initialized: whether the channel is initialized
  58  * @inuse: whether the channel is in use
  59  * @lock: protects multiple elements within this structure
  60  * @vdev: virtio dev associated with this channel
  61  * @vq: virtio queue associated with this channel
  62  * @tagpool: accounting for tag ids (and request slots)
  63  * @reqs: array of request slots
  64  * @max_tag: current number of request_slots allocated
  65  * @sg: scatter gather list which is used to pack a request (protected?)
  66  *
  67  * We keep all per-channel information in a structure.
  68  * This structure is allocated within the devices dev->mem space.
  69  * A pointer to the structure will get put in the transport private.
  70  *
  71  */
  72
  73 static struct virtio_chan {
  74         bool initialized;
  75         bool inuse;
  76
  77         spinlock_t lock;
  78
  79         struct p9_client *client;
  80         struct virtio_device *vdev;
  81         struct virtqueue *vq;
  82
  83         /* Scatterlist: can be too big for stack. */
  84         struct scatterlist sg[VIRTQUEUE_NUM];
  85 } channels[MAX_9P_CHAN];
  86
  87 /* How many bytes left in this page. */
  88 static unsigned int rest_of_page(void *data)
  89 {
  90         return PAGE_SIZE - ((unsigned long)data % PAGE_SIZE);
  91 }
  92
  93 /**
  94  * p9_virtio_close - reclaim resources of a channel
  95  * @trans: transport state
  96  *
  97  * This reclaims a channel by freeing its resources and
  98  * reseting its inuse flag.
  99  *
 100  */
 101
 102 static void p9_virtio_close(struct p9_client *client)
 103 {
 104         struct virtio_chan *chan = client->trans;
 105
 106         mutex_lock(&virtio_9p_lock);
 107         chan->inuse = false;
 108         mutex_unlock(&virtio_9p_lock);
 109 }
 110
 111 /**
 112  * req_done - callback which signals activity from the server
 113  * @vq: virtio queue activity was received on
 114  *
 115  * This notifies us that the server has triggered some activity
 116  * on the virtio channel - most likely a response to request we
 117  * sent.  Figure out which requests now have responses and wake up
 118  * those threads.
 119  *
 120  * Bugs: could do with some additional sanity checking, but appears to work.
 121  *
 122  */
 123
 124 static void req_done(struct virtqueue *vq)
 125 {
 126         struct virtio_chan *chan = vq->vdev->priv;
 127         struct p9_fcall *rc;
 128         unsigned int len;
 129         unsigned long flags;
 130         struct p9_req_t *req;
 131
 132         spin_lock_irqsave(&chan->lock, flags);
 133         while ((rc = chan->vq->vq_ops->get_buf(chan->vq, &len)) != NULL) {
 134                 req = p9_tag_lookup(chan->client, rc->tag);
 135                 req->status = REQ_STATUS_RCVD;
 136                 wake_up(req->wq);
 137         }
 138         /* In case queue is stopped waiting for more buffers. */
 139         spin_unlock_irqrestore(&chan->lock, flags);
 140 }
 141
 142 /**
 143  * pack_sg_list - pack a scatter gather list from a linear buffer
 144  * @sg: scatter/gather list to pack into
 145  * @start: which segment of the sg_list to start at
 146  * @limit: maximum segment to pack data to
 147  * @data: data to pack into scatter/gather list
 148  * @count: amount of data to pack into the scatter/gather list
 149  *
 150  * sg_lists have multiple segments of various sizes.  This will pack
 151  * arbitrary data into an existing scatter gather list, segmenting the
 152  * data as necessary within constraints.
 153  *
 154  */
 155
 156 static int
 157 pack_sg_list(struct scatterlist *sg, int start, int limit, char *data,
 158                                                                 int count)
 159 {
 160         int s;
 161         int index = start;
 162
 163         while (count) {
 164                 s = rest_of_page(data);
 165                 if (s > count)
 166                         s = count;
 167                 sg_set_buf(&sg[index++], data, s);
 168                 count -= s;
 169                 data += s;
 170                 BUG_ON(index > limit);
 171         }
 172
 173         return index-start;
 174 }
 175
 176 /**
 177  * p9_virtio_rpc - issue a request and wait for a response
 178  * @t: transport state
 179  * @tc: &p9_fcall request to transmit
 180  * @rc: &p9_fcall to put reponse into
 181  *
 182  */
 183
 184 static int
 185 p9_virtio_rpc(struct p9_client *c, struct p9_fcall *tc, struct p9_fcall **rc)
 186 {
 187         int in, out;
 188         int n, err, size;
 189         struct virtio_chan *chan = c->trans;
 190         char *rdata;
 191         struct p9_req_t *req;
 192         unsigned long flags;
 193
 194         if (*rc == NULL) {
 195                 *rc = kmalloc(sizeof(struct p9_fcall) + c->msize, GFP_KERNEL);
 196                 if (!*rc)
 197                         return -ENOMEM;
 198         }
 199
 200         rdata = (char *)*rc+sizeof(struct p9_fcall);
 201
 202         n = P9_NOTAG;
 203         if (tc->id != P9_TVERSION) {
 204                 n = p9_idpool_get(c->tagpool);
 205                 if (n < 0)
 206                         return -ENOMEM;
 207         }
 208
 209         spin_lock_irqsave(&chan->lock, flags);
 210         req = p9_tag_alloc(c, n);
 211         spin_unlock_irqrestore(&chan->lock, flags);
 212
 213         p9_set_tag(tc, n);
 214
 215         P9_DPRINTK(P9_DEBUG_TRANS, "9p debug: virtio rpc tag %d\n", n);
 216
 217         out = pack_sg_list(chan->sg, 0, VIRTQUEUE_NUM, tc->sdata, tc->size);
 218         in = pack_sg_list(chan->sg, out, VIRTQUEUE_NUM-out, rdata, c->msize);
 219
 220         req->status = REQ_STATUS_SENT;
 221
 222         if (chan->vq->vq_ops->add_buf(chan->vq, chan->sg, out, in, tc)) {
 223                 P9_DPRINTK(P9_DEBUG_TRANS,
 224                         "9p debug: virtio rpc add_buf returned failure");
 225                 return -EIO;
 226         }
 227
 228         chan->vq->vq_ops->kick(chan->vq);
 229
 230         wait_event(*req->wq, req->status == REQ_STATUS_RCVD);
 231
 232         size = le32_to_cpu(*(__le32 *) rdata);
 233
 234         err = p9_deserialize_fcall(rdata, size, *rc, c->dotu);
 235         if (err < 0) {
 236                 P9_DPRINTK(P9_DEBUG_TRANS,
 237                         "9p debug: virtio rpc deserialize returned %d\n", err);
 238                 return err;
 239         }
 240
 241 #ifdef CONFIG_NET_9P_DEBUG
 242         if ((p9_debug_level&P9_DEBUG_FCALL) == P9_DEBUG_FCALL) {
 243                 char buf[150];
 244
 245                 p9_printfcall(buf, sizeof(buf), *rc, c->dotu);
 246                 printk(KERN_NOTICE ">>> %p %s\n", c, buf);
 247         }
 248 #endif
 249
 250         p9_free_req(c, req);
 251
 252         return 0;
 253 }
 254
 255 /**
 256  * p9_virtio_probe - probe for existence of 9P virtio channels
 257  * @vdev: virtio device to probe
 258  *
 259  * This probes for existing virtio channels.  At present only
 260  * a single channel is in use, so in the future more work may need
 261  * to be done here.
 262  *
 263  */
 264
 265 static int p9_virtio_probe(struct virtio_device *vdev)
 266 {
 267         int err;
 268         struct virtio_chan *chan;
 269         int index;
 270
 271         mutex_lock(&virtio_9p_lock);
 272         index = chan_index++;
 273         chan = &channels[index];
 274         mutex_unlock(&virtio_9p_lock);
 275
 276         if (chan_index > MAX_9P_CHAN) {
 277                 printk(KERN_ERR "9p: virtio: Maximum channels exceeded\n");
 278                 BUG();
 279                 err = -ENOMEM;
 280                 goto fail;
 281         }
 282
 283         chan->vdev = vdev;
 284
 285         /* We expect one virtqueue, for requests. */
 286         chan->vq = vdev->config->find_vq(vdev, 0, req_done);
 287         if (IS_ERR(chan->vq)) {
 288                 err = PTR_ERR(chan->vq);
 289                 goto out_free_vq;
 290         }
 291         chan->vq->vdev->priv = chan;
 292         spin_lock_init(&chan->lock);
 293
 294         sg_init_table(chan->sg, VIRTQUEUE_NUM);
 295
 296         chan->inuse = false;
 297         chan->initialized = true;
 298         return 0;
 299
 300 out_free_vq:
 301         vdev->config->del_vq(chan->vq);
 302 fail:
 303         mutex_lock(&virtio_9p_lock);
 304         chan_index--;
 305         mutex_unlock(&virtio_9p_lock);
 306         return err;
 307 }
 308
 309
 310 /**
 311  * p9_virtio_create - allocate a new virtio channel
 312  * @client: client instance invoking this transport
 313  * @devname: string identifying the channel to connect to (unused)
 314  * @args: args passed from sys_mount() for per-transport options (unused)
 315  *
 316  * This sets up a transport channel for 9p communication.  Right now
 317  * we only match the first available channel, but eventually we couldlook up
 318  * alternate channels by matching devname versus a virtio_config entry.
 319  * We use a simple reference count mechanism to ensure that only a single
 320  * mount has a channel open at a time.
 321  *
 322  * Bugs: doesn't allow identification of a specific channel
 323  * to allocate, channels are allocated sequentially. This was
 324  * a pragmatic decision to get things rolling, but ideally some
 325  * way of identifying the channel to attach to would be nice
 326  * if we are going to support multiple channels.
 327  *
 328  */
 329
 330 static int
 331 p9_virtio_create(struct p9_client *client, const char *devname, char *args)
 332 {
 333         struct virtio_chan *chan = channels;
 334         int index = 0;
 335
 336         mutex_lock(&virtio_9p_lock);
 337         while (index < MAX_9P_CHAN) {
 338                 if (chan->initialized && !chan->inuse) {
 339                         chan->inuse = true;
 340                         break;
 341                 } else {
 342                         index++;
 343                         chan = &channels[index];
 344                 }
 345         }
 346         mutex_unlock(&virtio_9p_lock);
 347
 348         if (index >= MAX_9P_CHAN) {
 349                 printk(KERN_ERR "9p: no channels available\n");
 350                 return -ENODEV;
 351         }
 352
 353         client->trans = (void *)chan;
 354         chan->client = client;
 355
 356         return 0;
 357 }
 358
 359 /**
 360  * p9_virtio_remove - clean up resources associated with a virtio device
 361  * @vdev: virtio device to remove
 362  *
 363  */
 364
 365 static void p9_virtio_remove(struct virtio_device *vdev)
 366 {
 367         struct virtio_chan *chan = vdev->priv;
 368
 369         BUG_ON(chan->inuse);
 370
 371         if (chan->initialized) {
 372                 vdev->config->del_vq(chan->vq);
 373                 chan->initialized = false;
 374         }
 375 }
 376
 377 #define VIRTIO_ID_9P 9
 378
 379 static struct virtio_device_id id_table[] = {
 380         { VIRTIO_ID_9P, VIRTIO_DEV_ANY_ID },
 381         { 0 },
 382 };
 383
 384 /* The standard "struct lguest_driver": */
 385 static struct virtio_driver p9_virtio_drv = {
 386         .driver.name =  KBUILD_MODNAME,
 387         .driver.owner = THIS_MODULE,
 388         .id_table =     id_table,
 389         .probe =        p9_virtio_probe,
 390         .remove =       p9_virtio_remove,
 391 };
 392
 393 static struct p9_trans_module p9_virtio_trans = {
 394         .name = "virtio",
 395         .create = p9_virtio_create,
 396         .close = p9_virtio_close,
 397         .rpc = p9_virtio_rpc,
 398         .maxsize = PAGE_SIZE*16,
 399         .def = 0,
 400         .owner = THIS_MODULE,
 401 };
 402
 403 /* The standard init function */
 404 static int __init p9_virtio_init(void)
 405 {
 406         int count;
 407
 408         for (count = 0; count < MAX_9P_CHAN; count++)
 409                 channels[count].initialized = false;
 410
 411         v9fs_register_trans(&p9_virtio_trans);
 412         return register_virtio_driver(&p9_virtio_drv);
 413 }
 414
 415 static void __exit p9_virtio_cleanup(void)
 416 {
 417         unregister_virtio_driver(&p9_virtio_drv);
 418         v9fs_unregister_trans(&p9_virtio_trans);
 419 }
 420
 421 module_init(p9_virtio_init);
 422 module_exit(p9_virtio_cleanup);
 423
 424 MODULE_DEVICE_TABLE(virtio, id_table);
 425 MODULE_AUTHOR("Eric Van Hensbergen <ericvh@gmail.com>");
 426 MODULE_DESCRIPTION("Virtio 9p Transport");
 427 MODULE_LICENSE("GPL");