Message ID | 20220406095446.1187968-2-arnaud.pouliquen@foss.st.com (mailing list archive) |
---|---|
State | Superseded |
Headers | show |
Series | remoteproc: restructure the remoteproc VirtIO device | expand |
On Wed, Apr 06, 2022 at 11:54:43AM +0200, Arnaud Pouliquen wrote: > In preparation of the migration of the management of rvdev in > remoteproc_virtio.c, this patch spins off new functions to manage the > remoteproc virtio device. > - rproc_rvdev_add_device > - rproc_rvdev_remove_device > > The rproc_rvdev_add_device and rproc_rvdev_remove_device will be > moved to remoteproc_virtio.c. > > The rproc_vdev_data structure is introduced to provide information for > the rvdev creation. This structure allows to manage the rvdev and vrings > allocation in the rproc_rvdev_add_device function. > > Signed-off-by: Arnaud Pouliquen <arnaud.pouliquen@foss.st.com> > --- > drivers/remoteproc/remoteproc_core.c | 157 +++++++++++++---------- > drivers/remoteproc/remoteproc_internal.h | 15 +++ > 2 files changed, 106 insertions(+), 66 deletions(-) > > diff --git a/drivers/remoteproc/remoteproc_core.c b/drivers/remoteproc/remoteproc_core.c > index c510125769b9..3a469220ac73 100644 > --- a/drivers/remoteproc/remoteproc_core.c > +++ b/drivers/remoteproc/remoteproc_core.c > @@ -484,74 +484,23 @@ static int copy_dma_range_map(struct device *to, struct device *from) > return 0; > } > > -/** > - * rproc_handle_vdev() - handle a vdev fw resource > - * @rproc: the remote processor > - * @ptr: the vring resource descriptor > - * @offset: offset of the resource entry > - * @avail: size of available data (for sanity checking the image) > - * > - * This resource entry requests the host to statically register a virtio > - * device (vdev), and setup everything needed to support it. It contains > - * everything needed to make it possible: the virtio device id, virtio > - * device features, vrings information, virtio config space, etc... > - * > - * Before registering the vdev, the vrings are allocated from non-cacheable > - * physically contiguous memory. Currently we only support two vrings per > - * remote processor (temporary limitation). We might also want to consider > - * doing the vring allocation only later when ->find_vqs() is invoked, and > - * then release them upon ->del_vqs(). > - * > - * Note: @da is currently not really handled correctly: we dynamically > - * allocate it using the DMA API, ignoring requested hard coded addresses, > - * and we don't take care of any required IOMMU programming. This is all > - * going to be taken care of when the generic iommu-based DMA API will be > - * merged. Meanwhile, statically-addressed iommu-based firmware images should > - * use RSC_DEVMEM resource entries to map their required @da to the physical > - * address of their base CMA region (ouch, hacky!). > - * > - * Return: 0 on success, or an appropriate error code otherwise > - */ > -static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > - int offset, int avail) > +static struct rproc_vdev * > +rproc_rvdev_add_device(struct rproc *rproc, struct rproc_vdev_data *rvdev_data) > { > - struct fw_rsc_vdev *rsc = ptr; > - struct device *dev = &rproc->dev; > struct rproc_vdev *rvdev; > - int i, ret; > + struct fw_rsc_vdev *rsc = rvdev_data->rsc; > char name[16]; > - > - /* make sure resource isn't truncated */ > - if (struct_size(rsc, vring, rsc->num_of_vrings) + rsc->config_len > > - avail) { > - dev_err(dev, "vdev rsc is truncated\n"); > - return -EINVAL; > - } > - > - /* make sure reserved bytes are zeroes */ > - if (rsc->reserved[0] || rsc->reserved[1]) { > - dev_err(dev, "vdev rsc has non zero reserved bytes\n"); > - return -EINVAL; > - } > - > - dev_dbg(dev, "vdev rsc: id %d, dfeatures 0x%x, cfg len %d, %d vrings\n", > - rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); > - > - /* we currently support only two vrings per rvdev */ > - if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { > - dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); > - return -EINVAL; > - } > + int i, ret; > > rvdev = kzalloc(sizeof(*rvdev), GFP_KERNEL); > if (!rvdev) > - return -ENOMEM; > + return ERR_PTR(-ENOMEM); > > kref_init(&rvdev->refcount); > > - rvdev->id = rsc->id; > + rvdev->id = rvdev_data->id; > rvdev->rproc = rproc; > - rvdev->index = rproc->nb_vdev++; > + rvdev->index = rvdev_data->index; > > /* Initialise vdev subdevice */ > snprintf(name, sizeof(name), "vdev%dbuffer", rvdev->index); > @@ -563,7 +512,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > ret = device_register(&rvdev->dev); > if (ret) { > put_device(&rvdev->dev); > - return ret; > + return ERR_PTR(ret); > } > > ret = copy_dma_range_map(&rvdev->dev, rproc->dev.parent); > @@ -576,7 +525,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > ret = dma_coerce_mask_and_coherent(&rvdev->dev, > dma_get_mask(rproc->dev.parent)); > if (ret) { > - dev_warn(dev, > + dev_warn(&rvdev->dev, > "Failed to set DMA mask %llx. Trying to continue... (%pe)\n", > dma_get_mask(rproc->dev.parent), ERR_PTR(ret)); > } > @@ -589,7 +538,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > } > > /* remember the resource offset*/ > - rvdev->rsc_offset = offset; > + rvdev->rsc_offset = rvdev_data->rsc_offset; > > /* allocate the vring resources */ > for (i = 0; i < rsc->num_of_vrings; i++) { > @@ -605,21 +554,20 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > rproc_add_subdev(rproc, &rvdev->subdev); > > - return 0; > + return rvdev; > > unwind_vring_allocations: > for (i--; i >= 0; i--) > rproc_free_vring(&rvdev->vring[i]); > free_rvdev: > device_unregister(&rvdev->dev); > - return ret; > + return ERR_PTR(ret); > } > > -void rproc_vdev_release(struct kref *ref) > +static void rproc_rvdev_remove_device(struct rproc_vdev *rvdev) > { > - struct rproc_vdev *rvdev = container_of(ref, struct rproc_vdev, refcount); > - struct rproc_vring *rvring; > struct rproc *rproc = rvdev->rproc; > + struct rproc_vring *rvring; > int id; > > for (id = 0; id < ARRAY_SIZE(rvdev->vring); id++) { > @@ -632,6 +580,83 @@ void rproc_vdev_release(struct kref *ref) > device_unregister(&rvdev->dev); > } > > +/** > + * rproc_handle_vdev() - handle a vdev fw resource > + * @rproc: the remote processor > + * @ptr: the vring resource descriptor > + * @offset: offset of the resource entry > + * @avail: size of available data (for sanity checking the image) > + * > + * This resource entry requests the host to statically register a virtio > + * device (vdev), and setup everything needed to support it. It contains > + * everything needed to make it possible: the virtio device id, virtio > + * device features, vrings information, virtio config space, etc... > + * > + * Before registering the vdev, the vrings are allocated from non-cacheable > + * physically contiguous memory. Currently we only support two vrings per > + * remote processor (temporary limitation). We might also want to consider > + * doing the vring allocation only later when ->find_vqs() is invoked, and > + * then release them upon ->del_vqs(). > + * > + * Note: @da is currently not really handled correctly: we dynamically > + * allocate it using the DMA API, ignoring requested hard coded addresses, > + * and we don't take care of any required IOMMU programming. This is all > + * going to be taken care of when the generic iommu-based DMA API will be > + * merged. Meanwhile, statically-addressed iommu-based firmware images should > + * use RSC_DEVMEM resource entries to map their required @da to the physical > + * address of their base CMA region (ouch, hacky!). > + * > + * Return: 0 on success, or an appropriate error code otherwise > + */ > +static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > + int offset, int avail) > +{ > + struct fw_rsc_vdev *rsc = ptr; > + struct device *dev = &rproc->dev; > + struct rproc_vdev *rvdev; > + struct rproc_vdev_data rvdev_data; > + > + /* make sure resource isn't truncated */ > + if (struct_size(rsc, vring, rsc->num_of_vrings) + rsc->config_len > > + avail) { > + dev_err(dev, "vdev rsc is truncated\n"); > + return -EINVAL; > + } > + > + /* make sure reserved bytes are zeroes */ > + if (rsc->reserved[0] || rsc->reserved[1]) { > + dev_err(dev, "vdev rsc has non zero reserved bytes\n"); > + return -EINVAL; > + } > + > + dev_dbg(dev, "vdev rsc: id %d, dfeatures 0x%x, cfg len %d, %d vrings\n", > + rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); > + > + /* we currently support only two vrings per rvdev */ > + if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { > + dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); > + return -EINVAL; > + } > + > + rvdev_data.id = rsc->id; > + rvdev_data.index = rproc->nb_vdev++; > + rvdev_data.rsc_offset = offset; > + rvdev_data.rsc = rsc; > + > + rvdev = rproc_rvdev_add_device(rproc, &rvdev_data); > + if (IS_ERR(rvdev)) > + return PTR_ERR(rvdev); > + > + return 0; > +} > + > +void rproc_vdev_release(struct kref *ref) > +{ > + struct rproc_vdev *rvdev = container_of(ref, struct rproc_vdev, refcount); > + > + rproc_rvdev_remove_device(rvdev); > +} > + > /** > * rproc_handle_trace() - handle a shared trace buffer resource > * @rproc: the remote processor > diff --git a/drivers/remoteproc/remoteproc_internal.h b/drivers/remoteproc/remoteproc_internal.h > index 72d4d3d7d94d..99f2ff88079f 100644 > --- a/drivers/remoteproc/remoteproc_internal.h > +++ b/drivers/remoteproc/remoteproc_internal.h > @@ -24,6 +24,21 @@ struct rproc_debug_trace { > struct rproc_mem_entry trace_mem; > }; > > +/** > + * struct rproc_vdev_data - remoteproc virtio device data > + * @rsc_offset: offset of the vdev's resource entry > + * @id: virtio device id (as in virtio_ids.h) > + * @index: vdev position versus other vdev declared in resource table > + * @rsc: pointer to the vdev resource entry. Valid onlyduring vdev init as the resource can > + * be cached by rproc. > + */ > +struct rproc_vdev_data { > + u32 rsc_offset; > + unsigned int id; > + unsigned int index; rvdev->index is a u32 so rproc_vdev_data::index should also be a u32. With the above: Reviewed-by: Mathieu Poirier <mathieu.poirier@linaro.org> > + struct fw_rsc_vdev *rsc; > +}; > + > /* from remoteproc_core.c */ > void rproc_release(struct kref *kref); > irqreturn_t rproc_vq_interrupt(struct rproc *rproc, int vq_id); > -- > 2.25.1 >
On Wed, Jun 01, 2022 at 11:29:45AM -0600, Mathieu Poirier wrote: > On Wed, Apr 06, 2022 at 11:54:43AM +0200, Arnaud Pouliquen wrote: > > In preparation of the migration of the management of rvdev in > > remoteproc_virtio.c, this patch spins off new functions to manage the > > remoteproc virtio device. > > - rproc_rvdev_add_device > > - rproc_rvdev_remove_device > > > > The rproc_rvdev_add_device and rproc_rvdev_remove_device will be > > moved to remoteproc_virtio.c. > > > > The rproc_vdev_data structure is introduced to provide information for > > the rvdev creation. This structure allows to manage the rvdev and vrings > > allocation in the rproc_rvdev_add_device function. > > > > Signed-off-by: Arnaud Pouliquen <arnaud.pouliquen@foss.st.com> > > --- > > drivers/remoteproc/remoteproc_core.c | 157 +++++++++++++---------- > > drivers/remoteproc/remoteproc_internal.h | 15 +++ > > 2 files changed, 106 insertions(+), 66 deletions(-) > > > > diff --git a/drivers/remoteproc/remoteproc_core.c b/drivers/remoteproc/remoteproc_core.c > > index c510125769b9..3a469220ac73 100644 > > --- a/drivers/remoteproc/remoteproc_core.c > > +++ b/drivers/remoteproc/remoteproc_core.c > > @@ -484,74 +484,23 @@ static int copy_dma_range_map(struct device *to, struct device *from) > > return 0; > > } > > > > -/** > > - * rproc_handle_vdev() - handle a vdev fw resource > > - * @rproc: the remote processor > > - * @ptr: the vring resource descriptor > > - * @offset: offset of the resource entry > > - * @avail: size of available data (for sanity checking the image) > > - * > > - * This resource entry requests the host to statically register a virtio > > - * device (vdev), and setup everything needed to support it. It contains > > - * everything needed to make it possible: the virtio device id, virtio > > - * device features, vrings information, virtio config space, etc... > > - * > > - * Before registering the vdev, the vrings are allocated from non-cacheable > > - * physically contiguous memory. Currently we only support two vrings per > > - * remote processor (temporary limitation). We might also want to consider > > - * doing the vring allocation only later when ->find_vqs() is invoked, and > > - * then release them upon ->del_vqs(). > > - * > > - * Note: @da is currently not really handled correctly: we dynamically > > - * allocate it using the DMA API, ignoring requested hard coded addresses, > > - * and we don't take care of any required IOMMU programming. This is all > > - * going to be taken care of when the generic iommu-based DMA API will be > > - * merged. Meanwhile, statically-addressed iommu-based firmware images should > > - * use RSC_DEVMEM resource entries to map their required @da to the physical > > - * address of their base CMA region (ouch, hacky!). > > - * > > - * Return: 0 on success, or an appropriate error code otherwise > > - */ > > -static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > - int offset, int avail) > > +static struct rproc_vdev * > > +rproc_rvdev_add_device(struct rproc *rproc, struct rproc_vdev_data *rvdev_data) > > { > > - struct fw_rsc_vdev *rsc = ptr; > > - struct device *dev = &rproc->dev; > > struct rproc_vdev *rvdev; > > - int i, ret; > > + struct fw_rsc_vdev *rsc = rvdev_data->rsc; > > char name[16]; > > - > > - /* make sure resource isn't truncated */ > > - if (struct_size(rsc, vring, rsc->num_of_vrings) + rsc->config_len > > > - avail) { > > - dev_err(dev, "vdev rsc is truncated\n"); > > - return -EINVAL; > > - } > > - > > - /* make sure reserved bytes are zeroes */ > > - if (rsc->reserved[0] || rsc->reserved[1]) { > > - dev_err(dev, "vdev rsc has non zero reserved bytes\n"); > > - return -EINVAL; > > - } > > - > > - dev_dbg(dev, "vdev rsc: id %d, dfeatures 0x%x, cfg len %d, %d vrings\n", > > - rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); > > - > > - /* we currently support only two vrings per rvdev */ > > - if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { > > - dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); > > - return -EINVAL; > > - } > > + int i, ret; > > > > rvdev = kzalloc(sizeof(*rvdev), GFP_KERNEL); > > if (!rvdev) > > - return -ENOMEM; > > + return ERR_PTR(-ENOMEM); > > > > kref_init(&rvdev->refcount); > > > > - rvdev->id = rsc->id; > > + rvdev->id = rvdev_data->id; > > rvdev->rproc = rproc; > > - rvdev->index = rproc->nb_vdev++; > > + rvdev->index = rvdev_data->index; > > > > /* Initialise vdev subdevice */ > > snprintf(name, sizeof(name), "vdev%dbuffer", rvdev->index); > > @@ -563,7 +512,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > ret = device_register(&rvdev->dev); > > if (ret) { > > put_device(&rvdev->dev); > > - return ret; > > + return ERR_PTR(ret); > > } > > > > ret = copy_dma_range_map(&rvdev->dev, rproc->dev.parent); > > @@ -576,7 +525,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > ret = dma_coerce_mask_and_coherent(&rvdev->dev, > > dma_get_mask(rproc->dev.parent)); > > if (ret) { > > - dev_warn(dev, > > + dev_warn(&rvdev->dev, > > "Failed to set DMA mask %llx. Trying to continue... (%pe)\n", > > dma_get_mask(rproc->dev.parent), ERR_PTR(ret)); > > } > > @@ -589,7 +538,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > } > > > > /* remember the resource offset*/ > > - rvdev->rsc_offset = offset; > > + rvdev->rsc_offset = rvdev_data->rsc_offset; > > > > /* allocate the vring resources */ > > for (i = 0; i < rsc->num_of_vrings; i++) { > > @@ -605,21 +554,20 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > > > rproc_add_subdev(rproc, &rvdev->subdev); > > > > - return 0; > > + return rvdev; > > > > unwind_vring_allocations: > > for (i--; i >= 0; i--) > > rproc_free_vring(&rvdev->vring[i]); > > free_rvdev: > > device_unregister(&rvdev->dev); > > - return ret; > > + return ERR_PTR(ret); > > } > > > > -void rproc_vdev_release(struct kref *ref) > > +static void rproc_rvdev_remove_device(struct rproc_vdev *rvdev) > > { > > - struct rproc_vdev *rvdev = container_of(ref, struct rproc_vdev, refcount); > > - struct rproc_vring *rvring; > > struct rproc *rproc = rvdev->rproc; > > + struct rproc_vring *rvring; > > int id; > > > > for (id = 0; id < ARRAY_SIZE(rvdev->vring); id++) { > > @@ -632,6 +580,83 @@ void rproc_vdev_release(struct kref *ref) > > device_unregister(&rvdev->dev); > > } > > > > +/** > > + * rproc_handle_vdev() - handle a vdev fw resource > > + * @rproc: the remote processor > > + * @ptr: the vring resource descriptor > > + * @offset: offset of the resource entry > > + * @avail: size of available data (for sanity checking the image) > > + * > > + * This resource entry requests the host to statically register a virtio > > + * device (vdev), and setup everything needed to support it. It contains > > + * everything needed to make it possible: the virtio device id, virtio > > + * device features, vrings information, virtio config space, etc... > > + * > > + * Before registering the vdev, the vrings are allocated from non-cacheable > > + * physically contiguous memory. Currently we only support two vrings per > > + * remote processor (temporary limitation). We might also want to consider > > + * doing the vring allocation only later when ->find_vqs() is invoked, and > > + * then release them upon ->del_vqs(). > > + * > > + * Note: @da is currently not really handled correctly: we dynamically > > + * allocate it using the DMA API, ignoring requested hard coded addresses, > > + * and we don't take care of any required IOMMU programming. This is all > > + * going to be taken care of when the generic iommu-based DMA API will be > > + * merged. Meanwhile, statically-addressed iommu-based firmware images should > > + * use RSC_DEVMEM resource entries to map their required @da to the physical > > + * address of their base CMA region (ouch, hacky!). > > + * > > + * Return: 0 on success, or an appropriate error code otherwise > > + */ > > +static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > + int offset, int avail) > > +{ > > + struct fw_rsc_vdev *rsc = ptr; > > + struct device *dev = &rproc->dev; > > + struct rproc_vdev *rvdev; > > + struct rproc_vdev_data rvdev_data; > > + > > + /* make sure resource isn't truncated */ > > + if (struct_size(rsc, vring, rsc->num_of_vrings) + rsc->config_len > > > + avail) { > > + dev_err(dev, "vdev rsc is truncated\n"); > > + return -EINVAL; > > + } > > + > > + /* make sure reserved bytes are zeroes */ > > + if (rsc->reserved[0] || rsc->reserved[1]) { > > + dev_err(dev, "vdev rsc has non zero reserved bytes\n"); > > + return -EINVAL; > > + } > > + > > + dev_dbg(dev, "vdev rsc: id %d, dfeatures 0x%x, cfg len %d, %d vrings\n", > > + rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); > > + > > + /* we currently support only two vrings per rvdev */ > > + if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { > > + dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); > > + return -EINVAL; > > + } > > + > > + rvdev_data.id = rsc->id; > > + rvdev_data.index = rproc->nb_vdev++; > > + rvdev_data.rsc_offset = offset; > > + rvdev_data.rsc = rsc; > > + > > + rvdev = rproc_rvdev_add_device(rproc, &rvdev_data); > > + if (IS_ERR(rvdev)) > > + return PTR_ERR(rvdev); > > + > > + return 0; > > +} > > + > > +void rproc_vdev_release(struct kref *ref) > > +{ > > + struct rproc_vdev *rvdev = container_of(ref, struct rproc_vdev, refcount); > > + > > + rproc_rvdev_remove_device(rvdev); I understand that rproc_rvdev_remove_device() is created to counter balance rproc_rvdev_add_device() but in this case it doesn't provide much. Moreover it is removed and rproc_vdev_release() renamed in patch 4, making that one more complex than it should be. As such please leave rproc_vdev_release() unchanged. > > +} > > + > > /** > > * rproc_handle_trace() - handle a shared trace buffer resource > > * @rproc: the remote processor > > diff --git a/drivers/remoteproc/remoteproc_internal.h b/drivers/remoteproc/remoteproc_internal.h > > index 72d4d3d7d94d..99f2ff88079f 100644 > > --- a/drivers/remoteproc/remoteproc_internal.h > > +++ b/drivers/remoteproc/remoteproc_internal.h > > @@ -24,6 +24,21 @@ struct rproc_debug_trace { > > struct rproc_mem_entry trace_mem; > > }; > > > > +/** > > + * struct rproc_vdev_data - remoteproc virtio device data > > + * @rsc_offset: offset of the vdev's resource entry > > + * @id: virtio device id (as in virtio_ids.h) > > + * @index: vdev position versus other vdev declared in resource table > > + * @rsc: pointer to the vdev resource entry. Valid onlyduring vdev init as the resource can > > + * be cached by rproc. > > + */ > > +struct rproc_vdev_data { > > + u32 rsc_offset; > > + unsigned int id; > > + unsigned int index; > > rvdev->index is a u32 so rproc_vdev_data::index should also be a u32. > > With the above: > > Reviewed-by: Mathieu Poirier <mathieu.poirier@linaro.org> I'll take that back to see how the above refactoring fans out. I am done reviewing this set. Thanks, Mathieu > > > > + struct fw_rsc_vdev *rsc; > > +}; > > + > > /* from remoteproc_core.c */ > > void rproc_release(struct kref *kref); > > irqreturn_t rproc_vq_interrupt(struct rproc *rproc, int vq_id); > > -- > > 2.25.1 > >
On Thu, Jun 02, 2022 at 11:51:52AM -0600, Mathieu Poirier wrote: > On Wed, Jun 01, 2022 at 11:29:45AM -0600, Mathieu Poirier wrote: > > On Wed, Apr 06, 2022 at 11:54:43AM +0200, Arnaud Pouliquen wrote: > > > In preparation of the migration of the management of rvdev in > > > remoteproc_virtio.c, this patch spins off new functions to manage the > > > remoteproc virtio device. > > > - rproc_rvdev_add_device > > > - rproc_rvdev_remove_device > > > > > > The rproc_rvdev_add_device and rproc_rvdev_remove_device will be > > > moved to remoteproc_virtio.c. > > > > > > The rproc_vdev_data structure is introduced to provide information for > > > the rvdev creation. This structure allows to manage the rvdev and vrings > > > allocation in the rproc_rvdev_add_device function. > > > > > > Signed-off-by: Arnaud Pouliquen <arnaud.pouliquen@foss.st.com> > > > --- > > > drivers/remoteproc/remoteproc_core.c | 157 +++++++++++++---------- > > > drivers/remoteproc/remoteproc_internal.h | 15 +++ > > > 2 files changed, 106 insertions(+), 66 deletions(-) > > > > > > diff --git a/drivers/remoteproc/remoteproc_core.c b/drivers/remoteproc/remoteproc_core.c > > > index c510125769b9..3a469220ac73 100644 > > > --- a/drivers/remoteproc/remoteproc_core.c > > > +++ b/drivers/remoteproc/remoteproc_core.c > > > @@ -484,74 +484,23 @@ static int copy_dma_range_map(struct device *to, struct device *from) > > > return 0; > > > } > > > > > > -/** > > > - * rproc_handle_vdev() - handle a vdev fw resource > > > - * @rproc: the remote processor > > > - * @ptr: the vring resource descriptor > > > - * @offset: offset of the resource entry > > > - * @avail: size of available data (for sanity checking the image) > > > - * > > > - * This resource entry requests the host to statically register a virtio > > > - * device (vdev), and setup everything needed to support it. It contains > > > - * everything needed to make it possible: the virtio device id, virtio > > > - * device features, vrings information, virtio config space, etc... > > > - * > > > - * Before registering the vdev, the vrings are allocated from non-cacheable > > > - * physically contiguous memory. Currently we only support two vrings per > > > - * remote processor (temporary limitation). We might also want to consider > > > - * doing the vring allocation only later when ->find_vqs() is invoked, and > > > - * then release them upon ->del_vqs(). > > > - * > > > - * Note: @da is currently not really handled correctly: we dynamically > > > - * allocate it using the DMA API, ignoring requested hard coded addresses, > > > - * and we don't take care of any required IOMMU programming. This is all > > > - * going to be taken care of when the generic iommu-based DMA API will be > > > - * merged. Meanwhile, statically-addressed iommu-based firmware images should > > > - * use RSC_DEVMEM resource entries to map their required @da to the physical > > > - * address of their base CMA region (ouch, hacky!). > > > - * > > > - * Return: 0 on success, or an appropriate error code otherwise > > > - */ > > > -static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > > - int offset, int avail) > > > +static struct rproc_vdev * > > > +rproc_rvdev_add_device(struct rproc *rproc, struct rproc_vdev_data *rvdev_data) > > > { > > > - struct fw_rsc_vdev *rsc = ptr; > > > - struct device *dev = &rproc->dev; > > > struct rproc_vdev *rvdev; > > > - int i, ret; > > > + struct fw_rsc_vdev *rsc = rvdev_data->rsc; > > > char name[16]; > > > - > > > - /* make sure resource isn't truncated */ > > > - if (struct_size(rsc, vring, rsc->num_of_vrings) + rsc->config_len > > > > - avail) { > > > - dev_err(dev, "vdev rsc is truncated\n"); > > > - return -EINVAL; > > > - } > > > - > > > - /* make sure reserved bytes are zeroes */ > > > - if (rsc->reserved[0] || rsc->reserved[1]) { > > > - dev_err(dev, "vdev rsc has non zero reserved bytes\n"); > > > - return -EINVAL; > > > - } > > > - > > > - dev_dbg(dev, "vdev rsc: id %d, dfeatures 0x%x, cfg len %d, %d vrings\n", > > > - rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); > > > - > > > - /* we currently support only two vrings per rvdev */ > > > - if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { > > > - dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); > > > - return -EINVAL; > > > - } > > > + int i, ret; > > > > > > rvdev = kzalloc(sizeof(*rvdev), GFP_KERNEL); > > > if (!rvdev) > > > - return -ENOMEM; > > > + return ERR_PTR(-ENOMEM); > > > > > > kref_init(&rvdev->refcount); > > > > > > - rvdev->id = rsc->id; > > > + rvdev->id = rvdev_data->id; > > > rvdev->rproc = rproc; > > > - rvdev->index = rproc->nb_vdev++; > > > + rvdev->index = rvdev_data->index; > > > > > > /* Initialise vdev subdevice */ > > > snprintf(name, sizeof(name), "vdev%dbuffer", rvdev->index); > > > @@ -563,7 +512,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > > ret = device_register(&rvdev->dev); > > > if (ret) { > > > put_device(&rvdev->dev); > > > - return ret; > > > + return ERR_PTR(ret); > > > } > > > > > > ret = copy_dma_range_map(&rvdev->dev, rproc->dev.parent); > > > @@ -576,7 +525,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > > ret = dma_coerce_mask_and_coherent(&rvdev->dev, > > > dma_get_mask(rproc->dev.parent)); > > > if (ret) { > > > - dev_warn(dev, > > > + dev_warn(&rvdev->dev, > > > "Failed to set DMA mask %llx. Trying to continue... (%pe)\n", > > > dma_get_mask(rproc->dev.parent), ERR_PTR(ret)); > > > } > > > @@ -589,7 +538,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > > } > > > > > > /* remember the resource offset*/ > > > - rvdev->rsc_offset = offset; > > > + rvdev->rsc_offset = rvdev_data->rsc_offset; > > > > > > /* allocate the vring resources */ > > > for (i = 0; i < rsc->num_of_vrings; i++) { > > > @@ -605,21 +554,20 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > > > > > rproc_add_subdev(rproc, &rvdev->subdev); > > > > > > - return 0; > > > + return rvdev; > > > > > > unwind_vring_allocations: > > > for (i--; i >= 0; i--) > > > rproc_free_vring(&rvdev->vring[i]); > > > free_rvdev: > > > device_unregister(&rvdev->dev); > > > - return ret; > > > + return ERR_PTR(ret); > > > } > > > > > > -void rproc_vdev_release(struct kref *ref) > > > +static void rproc_rvdev_remove_device(struct rproc_vdev *rvdev) > > > { > > > - struct rproc_vdev *rvdev = container_of(ref, struct rproc_vdev, refcount); > > > - struct rproc_vring *rvring; > > > struct rproc *rproc = rvdev->rproc; > > > + struct rproc_vring *rvring; > > > int id; > > > > > > for (id = 0; id < ARRAY_SIZE(rvdev->vring); id++) { > > > @@ -632,6 +580,83 @@ void rproc_vdev_release(struct kref *ref) > > > device_unregister(&rvdev->dev); > > > } > > > > > > +/** > > > + * rproc_handle_vdev() - handle a vdev fw resource > > > + * @rproc: the remote processor > > > + * @ptr: the vring resource descriptor > > > + * @offset: offset of the resource entry > > > + * @avail: size of available data (for sanity checking the image) > > > + * > > > + * This resource entry requests the host to statically register a virtio > > > + * device (vdev), and setup everything needed to support it. It contains > > > + * everything needed to make it possible: the virtio device id, virtio > > > + * device features, vrings information, virtio config space, etc... > > > + * > > > + * Before registering the vdev, the vrings are allocated from non-cacheable > > > + * physically contiguous memory. Currently we only support two vrings per > > > + * remote processor (temporary limitation). We might also want to consider > > > + * doing the vring allocation only later when ->find_vqs() is invoked, and > > > + * then release them upon ->del_vqs(). > > > + * > > > + * Note: @da is currently not really handled correctly: we dynamically > > > + * allocate it using the DMA API, ignoring requested hard coded addresses, > > > + * and we don't take care of any required IOMMU programming. This is all > > > + * going to be taken care of when the generic iommu-based DMA API will be > > > + * merged. Meanwhile, statically-addressed iommu-based firmware images should > > > + * use RSC_DEVMEM resource entries to map their required @da to the physical > > > + * address of their base CMA region (ouch, hacky!). > > > + * > > > + * Return: 0 on success, or an appropriate error code otherwise > > > + */ > > > +static int rproc_handle_vdev(struct rproc *rproc, void *ptr, > > > + int offset, int avail) > > > +{ > > > + struct fw_rsc_vdev *rsc = ptr; > > > + struct device *dev = &rproc->dev; > > > + struct rproc_vdev *rvdev; > > > + struct rproc_vdev_data rvdev_data; > > > + > > > + /* make sure resource isn't truncated */ > > > + if (struct_size(rsc, vring, rsc->num_of_vrings) + rsc->config_len > > > > + avail) { > > > + dev_err(dev, "vdev rsc is truncated\n"); > > > + return -EINVAL; > > > + } > > > + > > > + /* make sure reserved bytes are zeroes */ > > > + if (rsc->reserved[0] || rsc->reserved[1]) { > > > + dev_err(dev, "vdev rsc has non zero reserved bytes\n"); > > > + return -EINVAL; > > > + } > > > + > > > + dev_dbg(dev, "vdev rsc: id %d, dfeatures 0x%x, cfg len %d, %d vrings\n", > > > + rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); > > > + > > > + /* we currently support only two vrings per rvdev */ > > > + if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { > > > + dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); > > > + return -EINVAL; > > > + } > > > + > > > + rvdev_data.id = rsc->id; > > > + rvdev_data.index = rproc->nb_vdev++; > > > + rvdev_data.rsc_offset = offset; > > > + rvdev_data.rsc = rsc; > > > + > > > + rvdev = rproc_rvdev_add_device(rproc, &rvdev_data); > > > + if (IS_ERR(rvdev)) > > > + return PTR_ERR(rvdev); > > > + > > > + return 0; > > > +} > > > + > > > +void rproc_vdev_release(struct kref *ref) > > > +{ > > > + struct rproc_vdev *rvdev = container_of(ref, struct rproc_vdev, refcount); > > > + > > > + rproc_rvdev_remove_device(rvdev); > > I understand that rproc_rvdev_remove_device() is created to counter balance > rproc_rvdev_add_device() but in this case it doesn't provide much. Moreover it > is removed and rproc_vdev_release() renamed in patch 4, making that one more > complex than it should be. As such please leave rproc_vdev_release() unchanged. > > > > +} > > > + > > > /** > > > * rproc_handle_trace() - handle a shared trace buffer resource > > > * @rproc: the remote processor > > > diff --git a/drivers/remoteproc/remoteproc_internal.h b/drivers/remoteproc/remoteproc_internal.h > > > index 72d4d3d7d94d..99f2ff88079f 100644 > > > --- a/drivers/remoteproc/remoteproc_internal.h > > > +++ b/drivers/remoteproc/remoteproc_internal.h > > > @@ -24,6 +24,21 @@ struct rproc_debug_trace { > > > struct rproc_mem_entry trace_mem; > > > }; > > > > > > +/** > > > + * struct rproc_vdev_data - remoteproc virtio device data > > > + * @rsc_offset: offset of the vdev's resource entry > > > + * @id: virtio device id (as in virtio_ids.h) > > > + * @index: vdev position versus other vdev declared in resource table > > > + * @rsc: pointer to the vdev resource entry. Valid onlyduring vdev init as the resource can > > > + * be cached by rproc. > > > + */ > > > +struct rproc_vdev_data { > > > + u32 rsc_offset; > > > + unsigned int id; > > > + unsigned int index; > > > > rvdev->index is a u32 so rproc_vdev_data::index should also be a u32. > > > > With the above: > > > > Reviewed-by: Mathieu Poirier <mathieu.poirier@linaro.org> > > I'll take that back to see how the above refactoring fans out. > > I am done reviewing this set. You can drop the "RFC" for the next revision, we are well past that point. > > Thanks, > Mathieu > > > > > > > > + struct fw_rsc_vdev *rsc; > > > +}; > > > + > > > /* from remoteproc_core.c */ > > > void rproc_release(struct kref *kref); > > > irqreturn_t rproc_vq_interrupt(struct rproc *rproc, int vq_id); > > > -- > > > 2.25.1 > > >
diff --git a/drivers/remoteproc/remoteproc_core.c b/drivers/remoteproc/remoteproc_core.c index c510125769b9..3a469220ac73 100644 --- a/drivers/remoteproc/remoteproc_core.c +++ b/drivers/remoteproc/remoteproc_core.c @@ -484,74 +484,23 @@ static int copy_dma_range_map(struct device *to, struct device *from) return 0; } -/** - * rproc_handle_vdev() - handle a vdev fw resource - * @rproc: the remote processor - * @ptr: the vring resource descriptor - * @offset: offset of the resource entry - * @avail: size of available data (for sanity checking the image) - * - * This resource entry requests the host to statically register a virtio - * device (vdev), and setup everything needed to support it. It contains - * everything needed to make it possible: the virtio device id, virtio - * device features, vrings information, virtio config space, etc... - * - * Before registering the vdev, the vrings are allocated from non-cacheable - * physically contiguous memory. Currently we only support two vrings per - * remote processor (temporary limitation). We might also want to consider - * doing the vring allocation only later when ->find_vqs() is invoked, and - * then release them upon ->del_vqs(). - * - * Note: @da is currently not really handled correctly: we dynamically - * allocate it using the DMA API, ignoring requested hard coded addresses, - * and we don't take care of any required IOMMU programming. This is all - * going to be taken care of when the generic iommu-based DMA API will be - * merged. Meanwhile, statically-addressed iommu-based firmware images should - * use RSC_DEVMEM resource entries to map their required @da to the physical - * address of their base CMA region (ouch, hacky!). - * - * Return: 0 on success, or an appropriate error code otherwise - */ -static int rproc_handle_vdev(struct rproc *rproc, void *ptr, - int offset, int avail) +static struct rproc_vdev * +rproc_rvdev_add_device(struct rproc *rproc, struct rproc_vdev_data *rvdev_data) { - struct fw_rsc_vdev *rsc = ptr; - struct device *dev = &rproc->dev; struct rproc_vdev *rvdev; - int i, ret; + struct fw_rsc_vdev *rsc = rvdev_data->rsc; char name[16]; - - /* make sure resource isn't truncated */ - if (struct_size(rsc, vring, rsc->num_of_vrings) + rsc->config_len > - avail) { - dev_err(dev, "vdev rsc is truncated\n"); - return -EINVAL; - } - - /* make sure reserved bytes are zeroes */ - if (rsc->reserved[0] || rsc->reserved[1]) { - dev_err(dev, "vdev rsc has non zero reserved bytes\n"); - return -EINVAL; - } - - dev_dbg(dev, "vdev rsc: id %d, dfeatures 0x%x, cfg len %d, %d vrings\n", - rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); - - /* we currently support only two vrings per rvdev */ - if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { - dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); - return -EINVAL; - } + int i, ret; rvdev = kzalloc(sizeof(*rvdev), GFP_KERNEL); if (!rvdev) - return -ENOMEM; + return ERR_PTR(-ENOMEM); kref_init(&rvdev->refcount); - rvdev->id = rsc->id; + rvdev->id = rvdev_data->id; rvdev->rproc = rproc; - rvdev->index = rproc->nb_vdev++; + rvdev->index = rvdev_data->index; /* Initialise vdev subdevice */ snprintf(name, sizeof(name), "vdev%dbuffer", rvdev->index); @@ -563,7 +512,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, ret = device_register(&rvdev->dev); if (ret) { put_device(&rvdev->dev); - return ret; + return ERR_PTR(ret); } ret = copy_dma_range_map(&rvdev->dev, rproc->dev.parent); @@ -576,7 +525,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, ret = dma_coerce_mask_and_coherent(&rvdev->dev, dma_get_mask(rproc->dev.parent)); if (ret) { - dev_warn(dev, + dev_warn(&rvdev->dev, "Failed to set DMA mask %llx. Trying to continue... (%pe)\n", dma_get_mask(rproc->dev.parent), ERR_PTR(ret)); } @@ -589,7 +538,7 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, } /* remember the resource offset*/ - rvdev->rsc_offset = offset; + rvdev->rsc_offset = rvdev_data->rsc_offset; /* allocate the vring resources */ for (i = 0; i < rsc->num_of_vrings; i++) { @@ -605,21 +554,20 @@ static int rproc_handle_vdev(struct rproc *rproc, void *ptr, rproc_add_subdev(rproc, &rvdev->subdev); - return 0; + return rvdev; unwind_vring_allocations: for (i--; i >= 0; i--) rproc_free_vring(&rvdev->vring[i]); free_rvdev: device_unregister(&rvdev->dev); - return ret; + return ERR_PTR(ret); } -void rproc_vdev_release(struct kref *ref) +static void rproc_rvdev_remove_device(struct rproc_vdev *rvdev) { - struct rproc_vdev *rvdev = container_of(ref, struct rproc_vdev, refcount); - struct rproc_vring *rvring; struct rproc *rproc = rvdev->rproc; + struct rproc_vring *rvring; int id; for (id = 0; id < ARRAY_SIZE(rvdev->vring); id++) { @@ -632,6 +580,83 @@ void rproc_vdev_release(struct kref *ref) device_unregister(&rvdev->dev); } +/** + * rproc_handle_vdev() - handle a vdev fw resource + * @rproc: the remote processor + * @ptr: the vring resource descriptor + * @offset: offset of the resource entry + * @avail: size of available data (for sanity checking the image) + * + * This resource entry requests the host to statically register a virtio + * device (vdev), and setup everything needed to support it. It contains + * everything needed to make it possible: the virtio device id, virtio + * device features, vrings information, virtio config space, etc... + * + * Before registering the vdev, the vrings are allocated from non-cacheable + * physically contiguous memory. Currently we only support two vrings per + * remote processor (temporary limitation). We might also want to consider + * doing the vring allocation only later when ->find_vqs() is invoked, and + * then release them upon ->del_vqs(). + * + * Note: @da is currently not really handled correctly: we dynamically + * allocate it using the DMA API, ignoring requested hard coded addresses, + * and we don't take care of any required IOMMU programming. This is all + * going to be taken care of when the generic iommu-based DMA API will be + * merged. Meanwhile, statically-addressed iommu-based firmware images should + * use RSC_DEVMEM resource entries to map their required @da to the physical + * address of their base CMA region (ouch, hacky!). + * + * Return: 0 on success, or an appropriate error code otherwise + */ +static int rproc_handle_vdev(struct rproc *rproc, void *ptr, + int offset, int avail) +{ + struct fw_rsc_vdev *rsc = ptr; + struct device *dev = &rproc->dev; + struct rproc_vdev *rvdev; + struct rproc_vdev_data rvdev_data; + + /* make sure resource isn't truncated */ + if (struct_size(rsc, vring, rsc->num_of_vrings) + rsc->config_len > + avail) { + dev_err(dev, "vdev rsc is truncated\n"); + return -EINVAL; + } + + /* make sure reserved bytes are zeroes */ + if (rsc->reserved[0] || rsc->reserved[1]) { + dev_err(dev, "vdev rsc has non zero reserved bytes\n"); + return -EINVAL; + } + + dev_dbg(dev, "vdev rsc: id %d, dfeatures 0x%x, cfg len %d, %d vrings\n", + rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); + + /* we currently support only two vrings per rvdev */ + if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { + dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); + return -EINVAL; + } + + rvdev_data.id = rsc->id; + rvdev_data.index = rproc->nb_vdev++; + rvdev_data.rsc_offset = offset; + rvdev_data.rsc = rsc; + + rvdev = rproc_rvdev_add_device(rproc, &rvdev_data); + if (IS_ERR(rvdev)) + return PTR_ERR(rvdev); + + return 0; +} + +void rproc_vdev_release(struct kref *ref) +{ + struct rproc_vdev *rvdev = container_of(ref, struct rproc_vdev, refcount); + + rproc_rvdev_remove_device(rvdev); +} + /** * rproc_handle_trace() - handle a shared trace buffer resource * @rproc: the remote processor diff --git a/drivers/remoteproc/remoteproc_internal.h b/drivers/remoteproc/remoteproc_internal.h index 72d4d3d7d94d..99f2ff88079f 100644 --- a/drivers/remoteproc/remoteproc_internal.h +++ b/drivers/remoteproc/remoteproc_internal.h @@ -24,6 +24,21 @@ struct rproc_debug_trace { struct rproc_mem_entry trace_mem; }; +/** + * struct rproc_vdev_data - remoteproc virtio device data + * @rsc_offset: offset of the vdev's resource entry + * @id: virtio device id (as in virtio_ids.h) + * @index: vdev position versus other vdev declared in resource table + * @rsc: pointer to the vdev resource entry. Valid onlyduring vdev init as the resource can + * be cached by rproc. + */ +struct rproc_vdev_data { + u32 rsc_offset; + unsigned int id; + unsigned int index; + struct fw_rsc_vdev *rsc; +}; + /* from remoteproc_core.c */ void rproc_release(struct kref *kref); irqreturn_t rproc_vq_interrupt(struct rproc *rproc, int vq_id);
In preparation of the migration of the management of rvdev in remoteproc_virtio.c, this patch spins off new functions to manage the remoteproc virtio device. - rproc_rvdev_add_device - rproc_rvdev_remove_device The rproc_rvdev_add_device and rproc_rvdev_remove_device will be moved to remoteproc_virtio.c. The rproc_vdev_data structure is introduced to provide information for the rvdev creation. This structure allows to manage the rvdev and vrings allocation in the rproc_rvdev_add_device function. Signed-off-by: Arnaud Pouliquen <arnaud.pouliquen@foss.st.com> --- drivers/remoteproc/remoteproc_core.c | 157 +++++++++++++---------- drivers/remoteproc/remoteproc_internal.h | 15 +++ 2 files changed, 106 insertions(+), 66 deletions(-)