On Tue, May 24, 2016 at 03:31:26PM +0200, Marek Szyprowski wrote:
> This patch removes custom code for initialization and handling of
> reserved memory regions in s5p-mfc driver and replaces it with generic
> reserved memory regions api.
>
> s5p-mfc driver now handles two reserved memory regions defined by
> generic reserved memory bindings. Support for non-dt platform has been
> removed, because all supported platforms have been already converted to
> device tree.
>
> Signed-off-by: Marek Szyprowski <[email protected]>
> ---
> drivers/media/platform/s5p-mfc/s5p_mfc.c | 138
> ++++++++++++++-----------------
> 1 file changed, 63 insertions(+), 75 deletions(-)
>
> diff --git a/drivers/media/platform/s5p-mfc/s5p_mfc.c
> b/drivers/media/platform/s5p-mfc/s5p_mfc.c
> index d1d9d388..fff5f43 100644
> --- a/drivers/media/platform/s5p-mfc/s5p_mfc.c
> +++ b/drivers/media/platform/s5p-mfc/s5p_mfc.c
> @@ -22,6 +22,7 @@
> #include <media/v4l2-event.h>
> #include <linux/workqueue.h>
> #include <linux/of.h>
> +#include <linux/of_reserved_mem.h>
> #include <media/videobuf2-v4l2.h>
> #include "s5p_mfc_common.h"
> #include "s5p_mfc_ctrl.h"
> @@ -1043,66 +1044,71 @@ static const struct v4l2_file_operations s5p_mfc_fops
> = {
> .mmap = s5p_mfc_mmap,
> };
>
> -static int match_child(struct device *dev, void *data)
> -{
> - if (!dev_name(dev))
> - return 0;
> - return !strcmp(dev_name(dev), (char *)data);
> -}
> -
> +/* DMA memory related helper functions */
> static void s5p_mfc_memdev_release(struct device *dev)
> {
> - dma_release_declared_memory(dev);
> + of_reserved_mem_device_release(dev);
> }
>
> -static void *mfc_get_drv_data(struct platform_device *pdev);
> -
> -static int s5p_mfc_alloc_memdevs(struct s5p_mfc_dev *dev)
> +static struct device *s5p_mfc_alloc_memdev(struct device *dev,
> + const char *name, unsigned int idx)
> {
> - unsigned int mem_info[2] = { };
> + struct device *child;
> + int ret;
>
> - dev->mem_dev_l = devm_kzalloc(&dev->plat_dev->dev,
> - sizeof(struct device), GFP_KERNEL);
> - if (!dev->mem_dev_l) {
> - mfc_err("Not enough memory\n");
> - return -ENOMEM;
> + child = devm_kzalloc(dev, sizeof(struct device), GFP_KERNEL);
> + if (!child)
> + return NULL;
> +
> + device_initialize(child);
> + dev_set_name(child, "%s:%s", dev_name(dev), name);
> + child->parent = dev;
> + child->bus = dev->bus;
> + child->coherent_dma_mask = dev->coherent_dma_mask;
> + child->dma_mask = dev->dma_mask;
> + child->release = s5p_mfc_memdev_release;
> +
> + if (device_add(child) == 0) {
> + ret = of_reserved_mem_device_init_by_idx(child, dev->of_node,
> + idx);
> + if (ret == 0)
> + return child;
> }
>
> - dev_set_name(dev->mem_dev_l, "%s", "s5p-mfc-l");
> - dev->mem_dev_l->release = s5p_mfc_memdev_release;
> - device_initialize(dev->mem_dev_l);
> - of_property_read_u32_array(dev->plat_dev->dev.of_node,
> - "samsung,mfc-l", mem_info, 2);
> - if (dma_declare_coherent_memory(dev->mem_dev_l, mem_info[0],
> - mem_info[0], mem_info[1],
> - DMA_MEMORY_MAP | DMA_MEMORY_EXCLUSIVE) == 0) {
> - mfc_err("Failed to declare coherent memory for\n"
> - "MFC device\n");
> - return -ENOMEM;
> - }
> + put_device(child);
> + return NULL;
> +}
>
> - dev->mem_dev_r = devm_kzalloc(&dev->plat_dev->dev,
> - sizeof(struct device), GFP_KERNEL);
> - if (!dev->mem_dev_r) {
> - mfc_err("Not enough memory\n");
> - return -ENOMEM;
> - }
> +static int s5p_mfc_configure_dma_memory(struct s5p_mfc_dev *mfc_dev)
> +{
> + struct device *dev = &mfc_dev->plat_dev->dev;
>
> - dev_set_name(dev->mem_dev_r, "%s", "s5p-mfc-r");
> - dev->mem_dev_r->release = s5p_mfc_memdev_release;
> - device_initialize(dev->mem_dev_r);
> - of_property_read_u32_array(dev->plat_dev->dev.of_node,
> - "samsung,mfc-r", mem_info, 2);
> - if (dma_declare_coherent_memory(dev->mem_dev_r, mem_info[0],
> - mem_info[0], mem_info[1],
> - DMA_MEMORY_MAP | DMA_MEMORY_EXCLUSIVE) == 0) {
> - pr_err("Failed to declare coherent memory for\n"
> - "MFC device\n");
> - return -ENOMEM;
> + /*
> + * Create and initialize virtual devices for accessing
> + * reserved memory regions.
> + */
> + mfc_dev->mem_dev_l = s5p_mfc_alloc_memdev(dev, "left",
> + MFC_BANK1_ALLOC_CTX);
> + if (!mfc_dev->mem_dev_l)
> + return -ENODEV;
> + mfc_dev->mem_dev_r = s5p_mfc_alloc_memdev(dev, "right",
> + MFC_BANK2_ALLOC_CTX);
> + if (!mfc_dev->mem_dev_r) {
> + device_unregister(mfc_dev->mem_dev_l);
> + return -ENODEV;
> }
> +
> return 0;
> }
>
> +static void s5p_mfc_unconfigure_dma_memory(struct s5p_mfc_dev *mfc_dev)
> +{
> + device_unregister(mfc_dev->mem_dev_l);
> + device_unregister(mfc_dev->mem_dev_r);
> +}
> +
> +static void *mfc_get_drv_data(struct platform_device *pdev);
> +
> /* MFC probe function */
> static int s5p_mfc_probe(struct platform_device *pdev)
> {
> @@ -1128,12 +1134,6 @@ static int s5p_mfc_probe(struct platform_device *pdev)
>
> dev->variant = mfc_get_drv_data(pdev);
>
> - ret = s5p_mfc_init_pm(dev);
> - if (ret < 0) {
> - dev_err(&pdev->dev, "failed to get mfc clock source\n");
> - return ret;
> - }
> -
> res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
>
> dev->regs_base = devm_ioremap_resource(&pdev->dev, res);
> @@ -1154,25 +1154,16 @@ static int s5p_mfc_probe(struct platform_device *pdev)
> goto err_res;
> }
>
> - if (pdev->dev.of_node) {
> - ret = s5p_mfc_alloc_memdevs(dev);
> - if (ret < 0)
> - goto err_res;
> - } else {
> - dev->mem_dev_l = device_find_child(&dev->plat_dev->dev,
> - "s5p-mfc-l", match_child);
> - if (!dev->mem_dev_l) {
> - mfc_err("Mem child (L) device get failed\n");
> - ret = -ENODEV;
> - goto err_res;
> - }
> - dev->mem_dev_r = device_find_child(&dev->plat_dev->dev,
> - "s5p-mfc-r", match_child);
> - if (!dev->mem_dev_r) {
> - mfc_err("Mem child (R) device get failed\n");
> - ret = -ENODEV;
> - goto err_res;
> - }
> + ret = s5p_mfc_configure_dma_memory(dev);
> + if (ret < 0) {
> + dev_err(&pdev->dev, "failed to configure DMA memory\n");
> + return ret;
> + }
> +
> + ret = s5p_mfc_init_pm(dev);
> + if (ret < 0) {
> + dev_err(&pdev->dev, "failed to get mfc clock source\n");
Should you not be calling s5p_mfc_unconfigure_dma_memory(dev) here? It looks
like you are leaking memory.
Best regards,
Liviu
> + return ret;
> }
>
> vb2_dma_contig_set_max_seg_size(dev->mem_dev_l, DMA_BIT_MASK(32));
> @@ -1309,12 +1300,9 @@ static int s5p_mfc_remove(struct platform_device *pdev)
> s5p_mfc_release_firmware(dev);
> vb2_dma_contig_cleanup_ctx(dev->alloc_ctx[0]);
> vb2_dma_contig_cleanup_ctx(dev->alloc_ctx[1]);
> + s5p_mfc_unconfigure_dma_memory(dev);
> vb2_dma_contig_clear_max_seg_size(dev->mem_dev_l);
> vb2_dma_contig_clear_max_seg_size(dev->mem_dev_r);
> - if (pdev->dev.of_node) {
> - put_device(dev->mem_dev_l);
> - put_device(dev->mem_dev_r);
> - }
>
> s5p_mfc_final_pm(dev);
> return 0;
> --
> 1.9.2
>
> --
> To unsubscribe from this list: send the line "unsubscribe linux-samsung-soc"
> in
> the body of a message to [email protected]
> More majordomo info at http://vger.kernel.org/majordomo-info.html
--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to [email protected]
More majordomo info at http://vger.kernel.org/majordomo-info.html
