sjur.brandeland at stericsson.com
2012-Sep-24 12:33 UTC
[PATCHv4] virtio_console: Add support for remoteproc serial
From: Sjur Br?ndeland <sjur.brandeland at stericsson.com> Add a simple serial connection driver called VIRTIO_ID_RPROC_SERIAL (11) for communicating with a remote processor in an asymmetric multi-processing configuration. This implementation reuses the existing virtio_console implementation, and adds support for DMA allocation of data buffers and disables use of tty console and the virtio control queue. Signed-off-by: Sjur Br?ndeland <sjur.brandeland at stericsson.com> cc: Rusty Russell <rusty at rustcorp.com.au> cc: Michael S. Tsirkin <mst at redhat.com> cc: Amit Shah <amit.shah at redhat.com> cc: Ohad Ben-Cohen <ohad at wizery.com> cc: Linus Walleij <linus.walleij at linaro.org> cc: Arnd Bergmann <arnd at arndb.de> --- Changes since v3 are mostly related to freeing of dma-buffers: - Change port_fops_write() to use struct port_buffer when allocating memory. This is done in order to store the dma-address of the allocated buffers, so the correct dma-address can be passed to dma_free_coherent(). - Added pending_free_list for port_buf. dma_free_coherent() requires the irqs to be enabled, so if irqs are disabled we queue the buffer on the pending_free_list and free it later when irqs are enabled. - Remove #if around is_rproc_serial Thanks, Sjur drivers/char/virtio_console.c | 222 ++++++++++++++++++++++++++++++++++++----- include/linux/virtio_ids.h | 1 + 2 files changed, 199 insertions(+), 24 deletions(-) diff --git a/drivers/char/virtio_console.c b/drivers/char/virtio_console.c index cdf2f54..3af9a5d 100644 --- a/drivers/char/virtio_console.c +++ b/drivers/char/virtio_console.c @@ -35,8 +35,12 @@ #include <linux/wait.h> #include <linux/workqueue.h> #include <linux/module.h> +#include <linux/dma-mapping.h> +#include <linux/kconfig.h> #include "../tty/hvc/hvc_console.h" +#define rproc_enabled IS_ENABLED(CONFIG_REMOTEPROC) + /* * This is a global struct for storing common data for all the devices * this driver handles. @@ -109,6 +113,15 @@ struct port_buffer { size_t len; /* offset in the buf from which to consume data */ size_t offset; + + /* DMA address of buffer */ + dma_addr_t dma; + + /* Device we got DMA memory from */ + struct device *dev; + + /* List of pending dma buffers to free */ + struct list_head list; }; /* @@ -323,6 +336,11 @@ static bool is_console_port(struct port *port) return false; } +static bool is_rproc_serial(const struct virtio_device *vdev) +{ + return rproc_enabled && vdev->id.device == VIRTIO_ID_RPROC_SERIAL; +} + static inline bool use_multiport(struct ports_device *portdev) { /* @@ -334,20 +352,99 @@ static inline bool use_multiport(struct ports_device *portdev) return portdev->vdev->features[0] & (1 << VIRTIO_CONSOLE_F_MULTIPORT); } +static DEFINE_SPINLOCK(list_lock); +static LIST_HEAD(pending_free_list); + static void free_buf(struct port_buffer *buf) { - kfree(buf->buf); + unsigned long flags; + + if (!buf->dev) { + kfree(buf->buf); + goto freebuf; + } + + BUG_ON(!rproc_enabled); + + /* dma_free_coherent requires interrupts to be enabled */ + if (rproc_enabled && !irqs_disabled()) { + dma_free_coherent(buf->dev, buf->size, buf->buf, buf->dma); + + /* Release device refcnt and allow it to be freed */ + might_sleep(); + put_device(buf->dev); + goto freebuf; + } + + /* queue up dma-buffers to be freed later */ + spin_lock_irqsave(&list_lock, flags); + list_add_tail(&buf->list, &pending_free_list); + spin_unlock_irqrestore(&list_lock, flags); + return; + +freebuf: kfree(buf); } -static struct port_buffer *alloc_buf(size_t buf_size) +static void reclaim_dma_bufs(void) +{ + unsigned long flags; + struct port_buffer *buf, *tmp; + LIST_HEAD(tmp_list); + + WARN_ON(irqs_disabled()); + if (list_empty(&pending_free_list)) + return; + + BUG_ON(!rproc_enabled); + + /* Create a copy of the pending_free_list while holding the lock*/ + spin_lock_irqsave(&list_lock, flags); + list_cut_position(&tmp_list, &pending_free_list, + pending_free_list.prev); + spin_unlock_irqrestore(&list_lock, flags); + + /* Release the dma buffers, without irqs enabled */ + list_for_each_entry_safe(buf, tmp, &tmp_list, list) { + list_del(&buf->list); + free_buf(buf); + } +} + +static struct port_buffer *alloc_buf(struct virtqueue *vq, size_t buf_size) { struct port_buffer *buf; + if (is_rproc_serial(vq->vdev) && !irqs_disabled()) + reclaim_dma_bufs(); + buf = kmalloc(sizeof(*buf), GFP_KERNEL); if (!buf) goto fail; - buf->buf = kzalloc(buf_size, GFP_KERNEL); + + if (is_rproc_serial(vq->vdev)) { + /* + * Allocate DMA memory from ancestor. When a virtio + * device is created by remoteproc, the DMA memory is + * associated with the grandparent device: + * vdev => rproc => platform-dev. + * The code here would have been less quirky if + * DMA_MEMORY_INCLUDES_CHILDREN had been supported + * in dma-coherent.c + */ + if (!vq->vdev->dev.parent || !vq->vdev->dev.parent->parent) + goto free_buf; + buf->dev = vq->vdev->dev.parent->parent; + + /* Increase device refcnt to avoid freeing it*/ + get_device(buf->dev); + buf->buf = dma_alloc_coherent(buf->dev, buf_size, &buf->dma, + GFP_KERNEL); + } else { + buf->buf = kmalloc(buf_size, GFP_KERNEL); + buf->dev = NULL; + } + if (!buf->buf) goto free_buf; buf->len = 0; @@ -485,7 +582,10 @@ static void reclaim_consumed_buffers(struct port *port) return; } while ((buf = virtqueue_get_buf(port->out_vq, &len))) { - kfree(buf); + if (is_console_port(port)) + kfree(buf); + else + free_buf(buf); port->outvq_full = false; } } @@ -498,6 +598,7 @@ static ssize_t send_buf(struct port *port, void *in_buf, size_t in_count, ssize_t ret; unsigned long flags; unsigned int len; + struct port_buffer *buf = in_buf; out_vq = port->out_vq; @@ -505,8 +606,11 @@ static ssize_t send_buf(struct port *port, void *in_buf, size_t in_count, reclaim_consumed_buffers(port); - sg_init_one(sg, in_buf, in_count); - ret = virtqueue_add_buf(out_vq, sg, 1, 0, in_buf, GFP_ATOMIC); + if (is_console_port(port)) + sg_init_one(sg, in_buf, in_count); + else + sg_init_one(sg, buf->buf, in_count); + ret = virtqueue_add_buf(out_vq, sg, 1, 0, buf, GFP_ATOMIC); /* Tell Host to go! */ virtqueue_kick(out_vq); @@ -669,7 +773,7 @@ static ssize_t port_fops_write(struct file *filp, const char __user *ubuf, size_t count, loff_t *offp) { struct port *port; - char *buf; + struct port_buffer *buf; ssize_t ret; bool nonblock; @@ -696,11 +800,11 @@ static ssize_t port_fops_write(struct file *filp, const char __user *ubuf, count = min((size_t)(32 * 1024), count); - buf = kmalloc(count, GFP_KERNEL); + buf = alloc_buf(port->out_vq, count); if (!buf) return -ENOMEM; - ret = copy_from_user(buf, ubuf, count); + ret = copy_from_user(buf->buf, ubuf, count); if (ret) { ret = -EFAULT; goto free_buf; @@ -720,7 +824,7 @@ static ssize_t port_fops_write(struct file *filp, const char __user *ubuf, goto out; free_buf: - kfree(buf); + free_buf(buf); out: return ret; } @@ -770,6 +874,8 @@ static int port_fops_release(struct inode *inode, struct file *filp) reclaim_consumed_buffers(port); spin_unlock_irq(&port->outvq_lock); + if (is_rproc_serial(port->portdev->vdev) && !irqs_disabled()) + reclaim_dma_bufs(); /* * Locks aren't necessary here as a port can't be opened after * unplug, and if a port isn't unplugged, a kref would already @@ -918,7 +1024,8 @@ static void resize_console(struct port *port) return; vdev = port->portdev->vdev; - if (virtio_has_feature(vdev, VIRTIO_CONSOLE_F_SIZE)) + if (!is_rproc_serial(vdev) && + virtio_has_feature(vdev, VIRTIO_CONSOLE_F_SIZE)) hvc_resize(port->cons.hvc, port->cons.ws); } @@ -1102,10 +1209,10 @@ static unsigned int fill_queue(struct virtqueue *vq, spinlock_t *lock) nr_added_bufs = 0; do { - buf = alloc_buf(PAGE_SIZE); + buf = alloc_buf(vq, PAGE_SIZE); if (!buf) break; - + memset(buf->buf, 0, PAGE_SIZE); spin_lock_irq(lock); ret = add_inbuf(vq, buf); if (ret < 0) { @@ -1198,10 +1305,18 @@ static int add_port(struct ports_device *portdev, u32 id) goto free_device; } - /* - * If we're not using multiport support, this has to be a console port - */ - if (!use_multiport(port->portdev)) { + if (is_rproc_serial(port->portdev->vdev)) + /* + * For rproc_serial assume remote processor is connected. + * rproc_serial does not want the console port, but + * the generic port implementation. + */ + port->host_connected = true; + else if (!use_multiport(port->portdev)) { + /* + * If we're not using multiport support, + * this has to be a console port. + */ err = init_port_console(port); if (err) goto free_inbufs; @@ -1277,6 +1392,16 @@ static void remove_port_data(struct port *port) /* Remove buffers we queued up for the Host to send us data in. */ while ((buf = virtqueue_detach_unused_buf(port->in_vq))) free_buf(buf); + + /* + * Remove buffers from out queue for rproc-serial. We cannot afford + * to leak any DMA mem, so reclaim this memory even if this might be + * racy for the remote processor. + */ + if (is_rproc_serial(port->portdev->vdev)) { + while ((buf = virtqueue_detach_unused_buf(port->out_vq))) + free_buf(buf); + } } /* @@ -1722,13 +1847,17 @@ static int __devinit virtcons_probe(struct virtio_device *vdev) goto free; } - multiport = false; - portdev->config.max_nr_ports = 1; - if (virtio_config_val(vdev, VIRTIO_CONSOLE_F_MULTIPORT, - offsetof(struct virtio_console_config, - max_nr_ports), - &portdev->config.max_nr_ports) == 0) + /* Don't test MULTIPORT at all if we're rproc: not a valid feature! */ + if (!is_rproc_serial(vdev) && + virtio_config_val(vdev, VIRTIO_CONSOLE_F_MULTIPORT, + offsetof(struct virtio_console_config, + max_nr_ports), + &portdev->config.max_nr_ports) == 0) { multiport = true; + } else { + multiport = false; + portdev->config.max_nr_ports = 1; + } err = init_vqs(portdev); if (err < 0) { @@ -1838,6 +1967,16 @@ static unsigned int features[] = { VIRTIO_CONSOLE_F_MULTIPORT, }; +static struct virtio_device_id rproc_serial_id_table[] = { +#if IS_ENABLED(CONFIG_REMOTEPROC) + { VIRTIO_ID_RPROC_SERIAL, VIRTIO_DEV_ANY_ID }, +#endif + { 0 }, +}; + +static unsigned int rproc_serial_features[] = { +}; + #ifdef CONFIG_PM static int virtcons_freeze(struct virtio_device *vdev) { @@ -1922,6 +2061,20 @@ static struct virtio_driver virtio_console = { #endif }; +/* + * virtio_rproc_serial refers to __devinit function which causes + * section mismatch warnings. So use __refdata to silence warnings. + */ +static struct virtio_driver __refdata virtio_rproc_serial = { + .feature_table = rproc_serial_features, + .feature_table_size = ARRAY_SIZE(rproc_serial_features), + .driver.name = "virtio_rproc_serial", + .driver.owner = THIS_MODULE, + .id_table = rproc_serial_id_table, + .probe = virtcons_probe, + .remove = virtcons_remove, +}; + static int __init init(void) { int err; @@ -1941,12 +2094,33 @@ static int __init init(void) INIT_LIST_HEAD(&pdrvdata.consoles); INIT_LIST_HEAD(&pdrvdata.portdevs); - return register_virtio_driver(&virtio_console); + err = register_virtio_driver(&virtio_console); + if (err < 0) { + pr_err("Error %d registering virtio driver\n", err); + goto free; + } + err = register_virtio_driver(&virtio_rproc_serial); + if (err < 0) { + pr_err("Error %d registering virtio rproc serial driver\n", + err); + goto unregister; + } + return 0; +unregister: + unregister_virtio_driver(&virtio_console); +free: + if (pdrvdata.debugfs_dir) + debugfs_remove_recursive(pdrvdata.debugfs_dir); + class_destroy(pdrvdata.class); + return err; } static void __exit fini(void) { + reclaim_dma_bufs(); + unregister_virtio_driver(&virtio_console); + unregister_virtio_driver(&virtio_rproc_serial); class_destroy(pdrvdata.class); if (pdrvdata.debugfs_dir) diff --git a/include/linux/virtio_ids.h b/include/linux/virtio_ids.h index 270fb22..cb28b52 100644 --- a/include/linux/virtio_ids.h +++ b/include/linux/virtio_ids.h @@ -37,5 +37,6 @@ #define VIRTIO_ID_RPMSG 7 /* virtio remote processor messaging */ #define VIRTIO_ID_SCSI 8 /* virtio scsi */ #define VIRTIO_ID_9P 9 /* 9p virtio console */ +#define VIRTIO_ID_RPROC_SERIAL 11 /* virtio remoteproc serial link */ #endif /* _LINUX_VIRTIO_IDS_H */ -- 1.7.5.4
Amit Shah
2012-Sep-24 17:45 UTC
[PATCHv4] virtio_console: Add support for remoteproc serial
Hi Sjur, I'm sorry for not being able to look at this earlier. A general comment is to base this patchset on linux-next; we've been seeing more than usual activity for virtio_console this time around. I don't expect the conflicts to be big, though. On (Mon) 24 Sep 2012 [14:33:07], sjur.brandeland at stericsson.com wrote:> From: Sjur Br?ndeland <sjur.brandeland at stericsson.com> > > Add a simple serial connection driver called > VIRTIO_ID_RPROC_SERIAL (11) for communicating with a > remote processor in an asymmetric multi-processing > configuration. > > This implementation reuses the existing virtio_console > implementation, and adds support for DMA allocation > of data buffers and disables use of tty console and > the virtio control queue.Any specific reason to not use the control queue? It's just another virtio-serial port; the only special thing about it being it's an internal channel between the device and driver. If you're not going to implement any control commands, I guess you could conveniently not use the actual port, but keep it around, in case you find use for it later. The advantage will be that older kernels will work without any updates on newer devices.> Signed-off-by: Sjur Br?ndeland <sjur.brandeland at stericsson.com> > cc: Rusty Russell <rusty at rustcorp.com.au> > cc: Michael S. Tsirkin <mst at redhat.com> > cc: Amit Shah <amit.shah at redhat.com> > cc: Ohad Ben-Cohen <ohad at wizery.com> > cc: Linus Walleij <linus.walleij at linaro.org> > cc: Arnd Bergmann <arnd at arndb.de> > --- > > Changes since v3 are mostly related to freeing of dma-buffers: > - Change port_fops_write() to use struct port_buffer when allocating > memory. This is done in order to store the dma-address of the > allocated buffers, so the correct dma-address can be passed to > dma_free_coherent(). > - Added pending_free_list for port_buf. dma_free_coherent() requires > the irqs to be enabled, so if irqs are disabled we queue the buffer > on the pending_free_list and free it later when irqs are enabled. > - Remove #if around is_rproc_serial > > Thanks, > Sjur > > drivers/char/virtio_console.c | 222 ++++++++++++++++++++++++++++++++++++----- > include/linux/virtio_ids.h | 1 + > 2 files changed, 199 insertions(+), 24 deletions(-) > > diff --git a/drivers/char/virtio_console.c b/drivers/char/virtio_console.c > index cdf2f54..3af9a5d 100644 > --- a/drivers/char/virtio_console.c > +++ b/drivers/char/virtio_console.c > @@ -35,8 +35,12 @@ > #include <linux/wait.h> > #include <linux/workqueue.h> > #include <linux/module.h> > +#include <linux/dma-mapping.h> > +#include <linux/kconfig.h> > #include "../tty/hvc/hvc_console.h" > > +#define rproc_enabled IS_ENABLED(CONFIG_REMOTEPROC)Since 'rproc_enabled' could be false, suggest using 'is_rproc_enabled'.> + > /* > * This is a global struct for storing common data for all the devices > * this driver handles. > @@ -109,6 +113,15 @@ struct port_buffer { > size_t len; > /* offset in the buf from which to consume data */ > size_t offset; > + > + /* DMA address of buffer */ > + dma_addr_t dma; > + > + /* Device we got DMA memory from */ > + struct device *dev; > + > + /* List of pending dma buffers to free */ > + struct list_head list;Aha, nice. One of the comments I had with the earlier versions (I just went through all the revisions) was that you weren't using the port_buffer struct, and instead modifying all alloc_buf() and free_buf() calls. This is much more saner.> }; > > /* > @@ -323,6 +336,11 @@ static bool is_console_port(struct port *port) > return false; > } > > +static bool is_rproc_serial(const struct virtio_device *vdev) > +{ > + return rproc_enabled && vdev->id.device == VIRTIO_ID_RPROC_SERIAL; > +} > + > static inline bool use_multiport(struct ports_device *portdev) > { > /* > @@ -334,20 +352,99 @@ static inline bool use_multiport(struct ports_device *portdev) > return portdev->vdev->features[0] & (1 << VIRTIO_CONSOLE_F_MULTIPORT); > } > > +static DEFINE_SPINLOCK(list_lock); > +static LIST_HEAD(pending_free_list);The names list_lock, pending_free_list are very generic in the file's context. Please use more specific names.> + > static void free_buf(struct port_buffer *buf) > { > - kfree(buf->buf); > + unsigned long flags; > + > + if (!buf->dev) { > + kfree(buf->buf); > + goto freebuf; > + } > + > + BUG_ON(!rproc_enabled); > + > + /* dma_free_coherent requires interrupts to be enabled */ > + if (rproc_enabled && !irqs_disabled()) {You don't need to check for rproc_enabled here. Then, you can just invert the if condition (if (irqs_disabled()) and include the relevant block here. This way, you can make do without the goto and return mess below.> + dma_free_coherent(buf->dev, buf->size, buf->buf, buf->dma); > + > + /* Release device refcnt and allow it to be freed */ > + might_sleep(); > + put_device(buf->dev); > + goto freebuf; > + } > + > + /* queue up dma-buffers to be freed later */ > + spin_lock_irqsave(&list_lock, flags); > + list_add_tail(&buf->list, &pending_free_list); > + spin_unlock_irqrestore(&list_lock, flags); > + return; > + > +freebuf: > kfree(buf); > } > > -static struct port_buffer *alloc_buf(size_t buf_size) > +static void reclaim_dma_bufs(void) > +{ > + unsigned long flags; > + struct port_buffer *buf, *tmp; > + LIST_HEAD(tmp_list); > + > + WARN_ON(irqs_disabled()); > + if (list_empty(&pending_free_list)) > + return; > + > + BUG_ON(!rproc_enabled); > + > + /* Create a copy of the pending_free_list while holding the lock*/ > + spin_lock_irqsave(&list_lock, flags); > + list_cut_position(&tmp_list, &pending_free_list, > + pending_free_list.prev); > + spin_unlock_irqrestore(&list_lock, flags); > + > + /* Release the dma buffers, without irqs enabled */ > + list_for_each_entry_safe(buf, tmp, &tmp_list, list) { > + list_del(&buf->list); > + free_buf(buf); > + } > +} > + > +static struct port_buffer *alloc_buf(struct virtqueue *vq, size_t buf_size) > { > struct port_buffer *buf; > > + if (is_rproc_serial(vq->vdev) && !irqs_disabled()) > + reclaim_dma_bufs(); > + > buf = kmalloc(sizeof(*buf), GFP_KERNEL); > if (!buf) > goto fail; > - buf->buf = kzalloc(buf_size, GFP_KERNEL); > + > + if (is_rproc_serial(vq->vdev)) { > + /* > + * Allocate DMA memory from ancestor. When a virtio > + * device is created by remoteproc, the DMA memory is > + * associated with the grandparent device: > + * vdev => rproc => platform-dev. > + * The code here would have been less quirky if > + * DMA_MEMORY_INCLUDES_CHILDREN had been supported > + * in dma-coherent.c > + */ > + if (!vq->vdev->dev.parent || !vq->vdev->dev.parent->parent) > + goto free_buf; > + buf->dev = vq->vdev->dev.parent->parent; > + > + /* Increase device refcnt to avoid freeing it*/ > + get_device(buf->dev); > + buf->buf = dma_alloc_coherent(buf->dev, buf_size, &buf->dma, > + GFP_KERNEL);incorrect indentation> + } else { > + buf->buf = kmalloc(buf_size, GFP_KERNEL); > + buf->dev = NULL; > + } > + > if (!buf->buf) > goto free_buf; > buf->len = 0; > @@ -485,7 +582,10 @@ static void reclaim_consumed_buffers(struct port *port) > return; > } > while ((buf = virtqueue_get_buf(port->out_vq, &len))) { > - kfree(buf); > + if (is_console_port(port)) > + kfree(buf); > + else > + free_buf(buf);Hm?> port->outvq_full = false; > } > } > @@ -498,6 +598,7 @@ static ssize_t send_buf(struct port *port, void *in_buf, size_t in_count, > ssize_t ret; > unsigned long flags; > unsigned int len; > + struct port_buffer *buf = in_buf;This looks wrong: the buffer we receive here is the actual data (buf->buf). It can never be a port_buffer (buf).> > out_vq = port->out_vq; > > @@ -505,8 +606,11 @@ static ssize_t send_buf(struct port *port, void *in_buf, size_t in_count, > > reclaim_consumed_buffers(port); > > - sg_init_one(sg, in_buf, in_count); > - ret = virtqueue_add_buf(out_vq, sg, 1, 0, in_buf, GFP_ATOMIC); > + if (is_console_port(port))I think you're misinterpreting what is_console_port() is. It means if a port is associated with an hvc/tty device.> + sg_init_one(sg, in_buf, in_count); > + else > + sg_init_one(sg, buf->buf, in_count); > + ret = virtqueue_add_buf(out_vq, sg, 1, 0, buf, GFP_ATOMIC); > > /* Tell Host to go! */ > virtqueue_kick(out_vq); > @@ -669,7 +773,7 @@ static ssize_t port_fops_write(struct file *filp, const char __user *ubuf, > size_t count, loff_t *offp) > { > struct port *port; > - char *buf; > + struct port_buffer *buf; > ssize_t ret; > bool nonblock; > > @@ -696,11 +800,11 @@ static ssize_t port_fops_write(struct file *filp, const char __user *ubuf, > > count = min((size_t)(32 * 1024), count); > > - buf = kmalloc(count, GFP_KERNEL); > + buf = alloc_buf(port->out_vq, count); > if (!buf) > return -ENOMEM; > > - ret = copy_from_user(buf, ubuf, count); > + ret = copy_from_user(buf->buf, ubuf, count); > if (ret) { > ret = -EFAULT; > goto free_buf; > @@ -720,7 +824,7 @@ static ssize_t port_fops_write(struct file *filp, const char __user *ubuf, > goto out; > > free_buf: > - kfree(buf); > + free_buf(buf); > out: > return ret; > }OK, I now get what you did with send_buf() above. However, send_buf() now should be completely broken for non-rproc devices: you're allocating a buf instead of a buf->buf and passing that on to send_buf() as a void*. You should instead modify send_buf() to accept a struct port_buffer instead. Second, send_buf() receives a struct port_buffer(), but in the 'is_console_port()' case, you ignore that fact, and just pass on the void* pointer to sg_init_one(). You should instead pass buf->buf.> @@ -770,6 +874,8 @@ static int port_fops_release(struct inode *inode, struct file *filp) > reclaim_consumed_buffers(port); > spin_unlock_irq(&port->outvq_lock); > > + if (is_rproc_serial(port->portdev->vdev) && !irqs_disabled()) > + reclaim_dma_bufs(); > /* > * Locks aren't necessary here as a port can't be opened after > * unplug, and if a port isn't unplugged, a kref would already > @@ -918,7 +1024,8 @@ static void resize_console(struct port *port) > return; > > vdev = port->portdev->vdev; > - if (virtio_has_feature(vdev, VIRTIO_CONSOLE_F_SIZE)) > + if (!is_rproc_serial(vdev) && > + virtio_has_feature(vdev, VIRTIO_CONSOLE_F_SIZE)) > hvc_resize(port->cons.hvc, port->cons.ws);Why do you want to ensure !is_rproc_serial() here? As long as the device doesn't expose the VIRTIO_CONSOLE_F_SIZE feature, you should be fine, so this hunk can be dropped.> } > > @@ -1102,10 +1209,10 @@ static unsigned int fill_queue(struct virtqueue *vq, spinlock_t *lock) > > nr_added_bufs = 0; > do { > - buf = alloc_buf(PAGE_SIZE); > + buf = alloc_buf(vq, PAGE_SIZE); > if (!buf) > break; > - > + memset(buf->buf, 0, PAGE_SIZE);Why this memset here? 1. alloc_buf() already does kzalloc() 2. Is there any specific reason you want the buffer to be zeroed? I've recently realised zeroing out the buffer before giving it to the device serves no real purpose, and we're just slowing down the allocation here, so I'm tempted to convert the kzalloc() to kmalloc(), unless you have a specific need for zeroed pages.> spin_lock_irq(lock); > ret = add_inbuf(vq, buf); > if (ret < 0) { > @@ -1198,10 +1305,18 @@ static int add_port(struct ports_device *portdev, u32 id) > goto free_device; > } > > - /* > - * If we're not using multiport support, this has to be a console port > - */ > - if (!use_multiport(port->portdev)) { > + if (is_rproc_serial(port->portdev->vdev)) > + /* > + * For rproc_serial assume remote processor is connected. > + * rproc_serial does not want the console port, but > + * the generic port implementation.s/but/only> + */ > + port->host_connected = true; > + else if (!use_multiport(port->portdev)) { > + /* > + * If we're not using multiport support, > + * this has to be a console port. > + */ > err = init_port_console(port); > if (err) > goto free_inbufs; > @@ -1277,6 +1392,16 @@ static void remove_port_data(struct port *port) > /* Remove buffers we queued up for the Host to send us data in. */ > while ((buf = virtqueue_detach_unused_buf(port->in_vq))) > free_buf(buf); > + > + /* > + * Remove buffers from out queue for rproc-serial. We cannot afford > + * to leak any DMA mem, so reclaim this memory even if this might be > + * racy for the remote processor. > + */ > + if (is_rproc_serial(port->portdev->vdev)) { > + while ((buf = virtqueue_detach_unused_buf(port->out_vq))) > + free_buf(buf); > + }braces around if can be dropped.> } > > /* > @@ -1722,13 +1847,17 @@ static int __devinit virtcons_probe(struct virtio_device *vdev) > goto free; > } > > - multiport = false; > - portdev->config.max_nr_ports = 1; > - if (virtio_config_val(vdev, VIRTIO_CONSOLE_F_MULTIPORT, > - offsetof(struct virtio_console_config, > - max_nr_ports), > - &portdev->config.max_nr_ports) == 0) > + /* Don't test MULTIPORT at all if we're rproc: not a valid feature! */ > + if (!is_rproc_serial(vdev) && > + virtio_config_val(vdev, VIRTIO_CONSOLE_F_MULTIPORT, > + offsetof(struct virtio_console_config, > + max_nr_ports), > + &portdev->config.max_nr_ports) == 0) { > multiport = true; > + } else { > + multiport = false; > + portdev->config.max_nr_ports = 1; > + }Why introduce the else part at all? Let these two statements be as they are, and just add the !is_rproc_serial check to the if statement?> > err = init_vqs(portdev); > if (err < 0) { > @@ -1838,6 +1967,16 @@ static unsigned int features[] = { > VIRTIO_CONSOLE_F_MULTIPORT, > }; > > +static struct virtio_device_id rproc_serial_id_table[] = { > +#if IS_ENABLED(CONFIG_REMOTEPROC) > + { VIRTIO_ID_RPROC_SERIAL, VIRTIO_DEV_ANY_ID }, > +#endif > + { 0 }, > +}; > + > +static unsigned int rproc_serial_features[] = { > +}; > + > #ifdef CONFIG_PM > static int virtcons_freeze(struct virtio_device *vdev) > { > @@ -1922,6 +2061,20 @@ static struct virtio_driver virtio_console = { > #endif > }; > > +/* > + * virtio_rproc_serial refers to __devinit function which causes > + * section mismatch warnings. So use __refdata to silence warnings. > + */ > +static struct virtio_driver __refdata virtio_rproc_serial = { > + .feature_table = rproc_serial_features, > + .feature_table_size = ARRAY_SIZE(rproc_serial_features), > + .driver.name = "virtio_rproc_serial", > + .driver.owner = THIS_MODULE, > + .id_table = rproc_serial_id_table, > + .probe = virtcons_probe, > + .remove = virtcons_remove, > +}; > + > static int __init init(void) > { > int err; > @@ -1941,12 +2094,33 @@ static int __init init(void) > INIT_LIST_HEAD(&pdrvdata.consoles); > INIT_LIST_HEAD(&pdrvdata.portdevs); > > - return register_virtio_driver(&virtio_console); > + err = register_virtio_driver(&virtio_console); > + if (err < 0) { > + pr_err("Error %d registering virtio driver\n", err); > + goto free; > + }This hunk is already present in linux-next; rebasing over that should get rid of it. Thanks, Amit -- To unsubscribe from this list: send the line "unsubscribe linux-kernel" in the body of a message to majordomo at vger.kernel.org More majordomo info at http://vger.kernel.org/majordomo-info.html Please read the FAQ at http://www.tux.org/lkml/
Sjur BRENDELAND
2012-Sep-24 21:50 UTC
[PATCHv4] virtio_console: Add support for remoteproc serial
Hi Amit,> I'm sorry for not being able to look at this earlier.No worries. I'll try to respin and retest this patch by tomorrow. If you by any chance could find time to review so could make it in time for 3.7 it would be great :-)> A general comment is to base this patchset on linux-next; we've been > seeing more than usual activity for virtio_console this time around. > I don't expect the conflicts to be big, though.Sure, I'll based the next patch on linux-next. ...> > This implementation reuses the existing virtio_console > > implementation, and adds support for DMA allocation > > of data buffers and disables use of tty console and > > the virtio control queue. > > Any specific reason to not use the control queue? It's just another > virtio-serial port; the only special thing about it being it's an > internal channel between the device and driver.Yes, as mention to Michael earlier. I use rproc_serial for talking to a modem running in early boot phases, before the OS has started, or when the modem is executing it's crash handler. In both these cases the modem run in a very limited execution environment, so I want to keep the protocol and handling of the vqs as simple as possible. Due to this I really don't want more than single pair of vqs. We also have very simple use-cases. The port is opened once in the life-time of the modem, and only reopened after a cold-start of the modem. So I should not get into any issues with race conditions.> If you're not going to implement any control commands, I guess you > could conveniently not use the actual port, but keep it around, in > case you find use for it later. The advantage will be that older > kernels will work without any updates on newer devices.With the current usage pattern I have in mind, I'd rather add this feature later when/if needed. We can always add a new feature bit for this if we introduce the control channel later on. ...> > +#define rproc_enabled IS_ENABLED(CONFIG_REMOTEPROC) > > Since 'rproc_enabled' could be false, suggest using 'is_rproc_enabled'.Ok, I'll change this. ...> > @@ -109,6 +113,15 @@ struct port_buffer { > > size_t len; > > /* offset in the buf from which to consume data */ > > size_t offset; > > + > > + /* DMA address of buffer */ > > + dma_addr_t dma; > > + > > + /* Device we got DMA memory from */ > > + struct device *dev; > > + > > + /* List of pending dma buffers to free */ > > + struct list_head list; > > Aha, nice. One of the comments I had with the earlier versions (I > just went through all the revisions) was that you weren't using the > port_buffer struct, and instead modifying all alloc_buf() and > free_buf() calls. This is much more saner.Yes, it was cleaner when I started using port_buffer more place. And as mentioned below, I'll start using port buffer from put_chars() as well, this will improve a few things.> > +static DEFINE_SPINLOCK(list_lock); > > +static LIST_HEAD(pending_free_list); > > The names list_lock, pending_free_list are very generic in the file's > context. Please use more specific names.Sure, I'll rename these.> > > + > > static void free_buf(struct port_buffer *buf) > > { > > - kfree(buf->buf); > > + unsigned long flags; > > + > > + if (!buf->dev) { > > + kfree(buf->buf); > > + goto freebuf; > > + } > > + > > + BUG_ON(!rproc_enabled); > > + > > + /* dma_free_coherent requires interrupts to be enabled */ > > + if (rproc_enabled && !irqs_disabled()) { > > You don't need to check for rproc_enabled here.Actually I do need this check. The reason is that I am exploiting gcc's ability to discard dead code. When I compile for arch's that does not have DMA, this block is dead and will be discarded. This way I avoid the link error for the missing symbol dma_free_coherent(). But I can add a comment on this.> Then, you can just invert the if condition (if (irqs_disabled()) and > include the relevant block here. This way, you can make do without > the goto and return mess below.Yeah, I did an earlier version without goto, but I wanted to separate the rproc / non-rproc clearly to make it easier to see what happened if rproc was disabled. But I'll have a stab at refactoring this code again.> > + dma_free_coherent(buf->dev, buf->size, buf->buf, buf->dma); > > + > > + /* Release device refcnt and allow it to be freed */ > > + might_sleep(); > > + put_device(buf->dev); > > + goto freebuf; > > + } > > +...> > + if (!vq->vdev->dev.parent || !vq->vdev->dev.parent->parent) > > + goto free_buf; > > + buf->dev = vq->vdev->dev.parent->parent; > > + > > + /* Increase device refcnt to avoid freeing it*/ > > + get_device(buf->dev); > > + buf->buf = dma_alloc_coherent(buf->dev, buf_size, &buf- > >dma, > > + GFP_KERNEL); > > incorrect indentationOK, I'll fix this.> > @@ -485,7 +582,10 @@ static void reclaim_consumed_buffers(struct port > *port) > > return; > > } > > while ((buf = virtqueue_get_buf(port->out_vq, &len))) { > > - kfree(buf); > > + if (is_console_port(port)) > > + kfree(buf); > > + else > > + free_buf(buf); > > Hm?See below.> > > port->outvq_full = false; > > } > > } > > @@ -498,6 +598,7 @@ static ssize_t send_buf(struct port *port, void > *in_buf, size_t in_count, > > ssize_t ret; > > unsigned long flags; > > unsigned int len; > > + struct port_buffer *buf = in_buf; > > This looks wrong: the buffer we receive here is the actual data > (buf->buf). It can never be a port_buffer (buf).See below.> > > > > out_vq = port->out_vq; > > > > @@ -505,8 +606,11 @@ static ssize_t send_buf(struct port *port, void > *in_buf, size_t in_count, > > > > reclaim_consumed_buffers(port); > > > > - sg_init_one(sg, in_buf, in_count); > > - ret = virtqueue_add_buf(out_vq, sg, 1, 0, in_buf, GFP_ATOMIC); > > + if (is_console_port(port)) > > I think you're misinterpreting what is_console_port() is. It means if > a port is associated with an hvc/tty device.See below.> > > + sg_init_one(sg, in_buf, in_count); > > + else > > + sg_init_one(sg, buf->buf, in_count); > > + ret = virtqueue_add_buf(out_vq, sg, 1, 0, buf, GFP_ATOMIC); > > > > /* Tell Host to go! */ > > virtqueue_kick(out_vq); > > @@ -669,7 +773,7 @@ static ssize_t port_fops_write(struct file *filp, > const char __user *ubuf, > > size_t count, loff_t *offp) > > { > > struct port *port; > > - char *buf; > > + struct port_buffer *buf; > > ssize_t ret; > > bool nonblock; > > > > @@ -696,11 +800,11 @@ static ssize_t port_fops_write(struct file > *filp, const char __user *ubuf, > > > > count = min((size_t)(32 * 1024), count); > > > > - buf = kmalloc(count, GFP_KERNEL); > > + buf = alloc_buf(port->out_vq, count); > > if (!buf) > > return -ENOMEM; > > > > - ret = copy_from_user(buf, ubuf, count); > > + ret = copy_from_user(buf->buf, ubuf, count); > > if (ret) { > > ret = -EFAULT; > > goto free_buf; > > @@ -720,7 +824,7 @@ static ssize_t port_fops_write(struct file *filp, > const char __user *ubuf, > > goto out; > > > > free_buf: > > - kfree(buf); > > + free_buf(buf); > > out: > > return ret; > > } > > OK, I now get what you did with send_buf() above. However, send_buf() > now should be completely broken for non-rproc devices: you're > allocating a buf instead of a buf->buf and passing that on to > send_buf() as a void*. You should instead modify send_buf() to accept > a struct port_buffer instead. > > Second, send_buf() receives a struct port_buffer(), but in the > 'is_console_port()' case, you ignore that fact, and just pass on the > void* pointer to sg_init_one(). You should instead pass buf->buf.OK, so the issue here it that currently put_chars() passes a char-buffer to send_buf() instead of a port_buffer. The tests above tries to handle this case, distingusing between a tty and char device. I agree that this is not the best solution. But if I change put_chars to create a port_buffer and copy data into it I can avoid the crap you pointed at above. ...> > - if (virtio_has_feature(vdev, VIRTIO_CONSOLE_F_SIZE)) > > + if (!is_rproc_serial(vdev) && > > + virtio_has_feature(vdev, VIRTIO_CONSOLE_F_SIZE)) > > hvc_resize(port->cons.hvc, port->cons.ws); > > Why do you want to ensure !is_rproc_serial() here? As long as the > device doesn't expose the VIRTIO_CONSOLE_F_SIZE feature, you should be > fine, so this hunk can be dropped.I need this test because virtio_check_driver_offered_feature() called from virtio_has_feature will throw a BUG() if you test on a feature not declared in the driver's feature-set.> > @@ -1102,10 +1209,10 @@ static unsigned int fill_queue(struct > virtqueue *vq, spinlock_t *lock) > > > > nr_added_bufs = 0; > > do { > > - buf = alloc_buf(PAGE_SIZE); > > + buf = alloc_buf(vq, PAGE_SIZE); > > if (!buf) > > break; > > - > > + memset(buf->buf, 0, PAGE_SIZE); > > Why this memset here? > > 1. alloc_buf() already does kzalloc()It used to do that, but not anymore. This patch changes kzalloc() to kmalloc() in alloc_buf()> 2. Is there any specific reason you want the buffer to be zeroed? > > I've recently realised zeroing out the buffer before giving it to the > device serves no real purpose, and we're just slowing down the > allocation here, so I'm tempted to convert the kzalloc() to > kmalloc(), unless you have a specific need for zeroed pages.Agree, the only reason is that I did memset was not to change legacy behavior. I'd prefer to skip the memset too, so let's do that.> > > spin_lock_irq(lock); > > ret = add_inbuf(vq, buf); > > if (ret < 0) { > > @@ -1198,10 +1305,18 @@ static int add_port(struct ports_device > *portdev, u32 id) > > goto free_device; > > } > > > > - /* > > - * If we're not using multiport support, this has to be a console > port > > - */ > > - if (!use_multiport(port->portdev)) { > > + if (is_rproc_serial(port->portdev->vdev)) > > + /* > > + * For rproc_serial assume remote processor is connected. > > + * rproc_serial does not want the console port, but > > + * the generic port implementation. > > s/but/onlyOK, thanks.> > > + */ > > + port->host_connected = true; > > + else if (!use_multiport(port->portdev)) { > > + /* > > + * If we're not using multiport support, > > + * this has to be a console port. > > + */ > > err = init_port_console(port); > > if (err) > > goto free_inbufs; > > @@ -1277,6 +1392,16 @@ static void remove_port_data(struct port > *port) > > /* Remove buffers we queued up for the Host to send us data in. > */ > > while ((buf = virtqueue_detach_unused_buf(port->in_vq))) > > free_buf(buf); > > + > > + /* > > + * Remove buffers from out queue for rproc-serial. We cannot > afford > > + * to leak any DMA mem, so reclaim this memory even if this might > be > > + * racy for the remote processor. > > + */ > > + if (is_rproc_serial(port->portdev->vdev)) { > > + while ((buf = virtqueue_detach_unused_buf(port->out_vq))) > > + free_buf(buf); > > + } > > braces around if can be dropped.OK,> > @@ -1722,13 +1847,17 @@ static int __devinit virtcons_probe(struct > virtio_device *vdev) > > goto free; > > } > > > > - multiport = false; > > - portdev->config.max_nr_ports = 1; > > - if (virtio_config_val(vdev, VIRTIO_CONSOLE_F_MULTIPORT, > > - offsetof(struct virtio_console_config, > > - max_nr_ports), > > - &portdev->config.max_nr_ports) == 0) > > + /* Don't test MULTIPORT at all if we're rproc: not a valid > feature! */ > > + if (!is_rproc_serial(vdev) && > > + virtio_config_val(vdev, VIRTIO_CONSOLE_F_MULTIPORT, > > + offsetof(struct virtio_console_config, > > + max_nr_ports), > > + &portdev->config.max_nr_ports) == 0) { > > multiport = true; > > + } else { > > + multiport = false; > > + portdev->config.max_nr_ports = 1; > > + } > > Why introduce the else part at all? Let these two statements be as > they are, and just add the !is_rproc_serial check to the if statement?OK, I'll keep assignments before "if" and skip the else part. ...> - return register_virtio_driver(&virtio_console); > > + err = register_virtio_driver(&virtio_console); > > + if (err < 0) { > > + pr_err("Error %d registering virtio driver\n", err); > > + goto free; > > + } > > This hunk is already present in linux-next; rebasing over that should > get rid of it.Sure, I'll rebase next patch to linux-next and send a new patch tomorrow. Thanks, Sjur
Reasonably Related Threads
- [PATCHv4] virtio_console: Add support for remoteproc serial
- [PATCHv6 0/3] virtio_console: Add rproc_serial device
- [PATCHv6 0/3] virtio_console: Add rproc_serial device
- [PATCHv7 0/4] virtio_console: Add rproc_serial driver
- [PATCHv7 0/4] virtio_console: Add rproc_serial driver