s5p-jpeg: add support for exynos5433 clocks

Signed-off-by: Marek Szyprowski <m.szyprowski@samsung.com>

diff --git a/drivers/media/platform/s5p-jpeg/jpeg-core.c b/drivers/media/platform/s5p-jpeg/jpeg-core.c
index 6884839..9ec6311 100644 (file)
--- a/drivers/media/platform/s5p-jpeg/jpeg-core.c
+++ b/drivers/media/platform/s5p-jpeg/jpeg-core.c
@@ -2783,7 +2783,7 @@ static int s5p_jpeg_probe(struct platform_device *pdev)
 {
        struct s5p_jpeg *jpeg;
        struct resource *res;
-       int ret;
+       int i, ret;
 
        /* JPEG IP abstraction struct */
        jpeg = devm_kzalloc(&pdev->dev, sizeof(struct s5p_jpeg), GFP_KERNEL);
@@ -2818,17 +2818,15 @@ static int s5p_jpeg_probe(struct platform_device *pdev)
        }
 
        /* clocks */
-       jpeg->clk = clk_get(&pdev->dev, "jpeg");
-       if (IS_ERR(jpeg->clk)) {
-               dev_err(&pdev->dev, "cannot get clock\n");
-               ret = PTR_ERR(jpeg->clk);
-               return ret;
+       for (i = 0; i < jpeg->variant->num_clocks; i++) {
+               jpeg->clocks[i] = devm_clk_get(&pdev->dev,
+                                             jpeg->variant->clk_names[i]);
+               if (IS_ERR(jpeg->clocks[i])) {
+                       dev_err(&pdev->dev, "failed to get clock: %s\n",
+                               jpeg->variant->clk_names[i]);
+                       return PTR_ERR(jpeg->clocks[i]);
+               }
        }
-       dev_dbg(&pdev->dev, "clock source %p\n", jpeg->clk);
-
-       jpeg->sclk = clk_get(&pdev->dev, "sclk");
-       if (IS_ERR(jpeg->sclk))
-               dev_info(&pdev->dev, "sclk clock not available\n");
 
        /* v4l2 device */
        ret = v4l2_device_register(&pdev->dev, &jpeg->v4l2_dev);
@@ -2936,16 +2934,13 @@ device_register_rollback:
        v4l2_device_unregister(&jpeg->v4l2_dev);
 
 clk_get_rollback:
-       clk_put(jpeg->clk);
-       if (!IS_ERR(jpeg->sclk))
-               clk_put(jpeg->sclk);
-
        return ret;
 }
 
 static int s5p_jpeg_remove(struct platform_device *pdev)
 {
        struct s5p_jpeg *jpeg = platform_get_drvdata(pdev);
+       int i;
 
        pm_runtime_disable(jpeg->dev);
 
@@ -2958,15 +2953,10 @@ static int s5p_jpeg_remove(struct platform_device *pdev)
        v4l2_device_unregister(&jpeg->v4l2_dev);
 
        if (!pm_runtime_status_suspended(&pdev->dev)) {
-               clk_disable_unprepare(jpeg->clk);
-               if (!IS_ERR(jpeg->sclk))
-                       clk_disable_unprepare(jpeg->sclk);
+               for (i = jpeg->variant->num_clocks - 1; i >= 0; i--)
+                       clk_disable_unprepare(jpeg->clocks[i]);
        }
 
-       clk_put(jpeg->clk);
-       if (!IS_ERR(jpeg->sclk))
-               clk_put(jpeg->sclk);
-
        return 0;
 }
 
@@ -2974,10 +2964,10 @@ static int s5p_jpeg_remove(struct platform_device *pdev)
 static int s5p_jpeg_runtime_suspend(struct device *dev)
 {
        struct s5p_jpeg *jpeg = dev_get_drvdata(dev);
+       int i;
 
-       clk_disable_unprepare(jpeg->clk);
-       if (!IS_ERR(jpeg->sclk))
-               clk_disable_unprepare(jpeg->sclk);
+       for (i = jpeg->variant->num_clocks - 1; i >= 0; i--)
+               clk_disable_unprepare(jpeg->clocks[i]);
 
        return 0;
 }
@@ -2986,16 +2976,15 @@ static int s5p_jpeg_runtime_resume(struct device *dev)
 {
        struct s5p_jpeg *jpeg = dev_get_drvdata(dev);
        unsigned long flags;
-       int ret;
+       int i, ret;
 
-       ret = clk_prepare_enable(jpeg->clk);
-       if (ret < 0)
-               return ret;
-
-       if (!IS_ERR(jpeg->sclk)) {
-               ret = clk_prepare_enable(jpeg->sclk);
-               if (ret < 0)
+       for (i = 0; i < jpeg->variant->num_clocks; i++) {
+               ret = clk_prepare_enable(jpeg->clocks[i]);
+               if (ret) {
+                       while (--i > 0)
+                               clk_disable_unprepare(jpeg->clocks[i]);
                        return ret;
+               }
        }
 
        spin_lock_irqsave(&jpeg->slock, flags);
@@ -3049,6 +3038,8 @@ static struct s5p_jpeg_variant s5p_jpeg_drvdata = {
        .jpeg_irq       = s5p_jpeg_irq,
        .m2m_ops        = &s5p_jpeg_m2m_ops,
        .fmt_ver_flag   = SJPEG_FMT_FLAG_S5P,
+       .clk_names      = {"jpeg"},
+       .num_clocks     = 1,
 };
 
 static struct s5p_jpeg_variant exynos3250_jpeg_drvdata = {
@@ -3057,6 +3048,8 @@ static struct s5p_jpeg_variant exynos3250_jpeg_drvdata = {
        .m2m_ops        = &exynos3250_jpeg_m2m_ops,
        .fmt_ver_flag   = SJPEG_FMT_FLAG_EXYNOS3250,
        .hw3250_compat  = 1,
+       .clk_names      = {"jpeg", "sclk"},
+       .num_clocks     = 2,
 };
 
 static struct s5p_jpeg_variant exynos4_jpeg_drvdata = {
@@ -3066,6 +3059,8 @@ static struct s5p_jpeg_variant exynos4_jpeg_drvdata = {
        .fmt_ver_flag   = SJPEG_FMT_FLAG_EXYNOS4,
        .htbl_reinit    = 1,
        .hw_ex4_compat  = 1,
+       .clk_names      = {"jpeg"},
+       .num_clocks     = 1,
 };
 
 static struct s5p_jpeg_variant exynos5420_jpeg_drvdata = {
@@ -3075,6 +3070,8 @@ static struct s5p_jpeg_variant exynos5420_jpeg_drvdata = {
        .fmt_ver_flag   = SJPEG_FMT_FLAG_EXYNOS3250,    /* intentionally 3250 */
        .hw3250_compat  = 1,
        .htbl_reinit    = 1,
+       .clk_names      = {"jpeg"},
+       .num_clocks     = 1,
 };
 
 static struct s5p_jpeg_variant exynos5433_jpeg_drvdata = {
@@ -3084,6 +3081,8 @@ static struct s5p_jpeg_variant exynos5433_jpeg_drvdata = {
        .fmt_ver_flag   = SJPEG_FMT_FLAG_EXYNOS4,
        .htbl_reinit    = 1,
        .hw_ex4_compat  = 1,
+       .clk_names      = {"pclk", "aclk", "aclk_xiu", "sclk"},
+       .num_clocks     = 4,
 };
 
 static const struct of_device_id samsung_jpeg_match[] = {

diff --git a/drivers/media/platform/s5p-jpeg/jpeg-core.h b/drivers/media/platform/s5p-jpeg/jpeg-core.h
index 4f197a5..9b1db09 100644 (file)
--- a/drivers/media/platform/s5p-jpeg/jpeg-core.h
+++ b/drivers/media/platform/s5p-jpeg/jpeg-core.h
@@ -20,6 +20,8 @@
 
 #define S5P_JPEG_M2M_NAME              "s5p-jpeg"
 
+#define JPEG_MAX_CLOCKS                        4
+
 /* JPEG compression quality setting */
 #define S5P_JPEG_COMPR_QUAL_BEST       0
 #define S5P_JPEG_COMPR_QUAL_WORST      3
@@ -106,8 +108,7 @@ enum  exynos4_jpeg_img_quality_level {
  * @m2m_dev:           v4l2 mem2mem device data
  * @regs:              JPEG IP registers mapping
  * @irq:               JPEG IP irq
- * @clk:               JPEG IP clock
- * @sclk:              Exynos3250 JPEG IP special clock
+ * @clocks:            JPEG IP clock(s)
  * @dev:               JPEG IP struct device
  * @alloc_ctx:         videobuf2 memory allocator's context
  * @variant:           driver variant to be used
@@ -127,8 +128,7 @@ struct s5p_jpeg {
        void __iomem            *regs;
        unsigned int            irq;
        enum exynos4_jpeg_result irq_ret;
-       struct clk              *clk;
-       struct clk              *sclk;
+       struct clk              *clocks[JPEG_MAX_CLOCKS];
        struct device           *dev;
        void                    *alloc_ctx;
        struct s5p_jpeg_variant *variant;
@@ -143,6 +143,8 @@ struct s5p_jpeg_variant {
        unsigned int            hw_ex4_compat:1;
        struct v4l2_m2m_ops     *m2m_ops;
        irqreturn_t             (*jpeg_irq)(int irq, void *priv);
+       const char              *clk_names[JPEG_MAX_CLOCKS];
+       int                     num_clocks;
 };
 
 /**