[media] davinci: vpif display: Add power management support

Implement power management operations - suspend and resume as part of
dev_pm_ops for VPIF display driver.

Signed-off-by: Manjunath Hadli <manjunath.hadli@ti.com>
Signed-off-by: Lad, Prabhakar <prabhakar.lad@ti.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

1 files changed, 71 insertions, 0 deletions

diff --git a/drivers/media/video/davinci/vpif_display.c b/drivers/media/video/davinci/vpif_display.c
index c3e2c193dda1..e129c98921ad 100644
--- a/drivers/media/video/davinci/vpif_display.c
+++ b/drivers/media/video/davinci/vpif_display.c
@@ -1882,10 +1882,81 @@ static int vpif_remove(struct platform_device *device)
         return 0;
 }
 
+#ifdef CONFIG_PM
+static int vpif_suspend(struct device *dev)
+{
+        struct common_obj *common;
+        struct channel_obj *ch;
+        int i;
+
+        for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) {
+                /* Get the pointer to the channel object */
+                ch = vpif_obj.dev[i];
+                common = &ch->common[VPIF_VIDEO_INDEX];
+                mutex_lock(&common->lock);
+                if (atomic_read(&ch->usrs) && common->io_usrs) {
+                        /* Disable channel */
+                        if (ch->channel_id == VPIF_CHANNEL2_VIDEO) {
+                                enable_channel2(0);
+                                channel2_intr_enable(0);
+                        }
+                        if (ch->channel_id == VPIF_CHANNEL3_VIDEO ||
+                                        common->started == 2) {
+                                enable_channel3(0);
+                                channel3_intr_enable(0);
+                        }
+                }
+                mutex_unlock(&common->lock);
+        }
+
+        return 0;
+}
+
+static int vpif_resume(struct device *dev)
+{
+
+        struct common_obj *common;
+        struct channel_obj *ch;
+        int i;
+
+        for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) {
+                /* Get the pointer to the channel object */
+                ch = vpif_obj.dev[i];
+                common = &ch->common[VPIF_VIDEO_INDEX];
+                mutex_lock(&common->lock);
+                if (atomic_read(&ch->usrs) && common->io_usrs) {
+                        /* Enable channel */
+                        if (ch->channel_id == VPIF_CHANNEL2_VIDEO) {
+                                enable_channel2(1);
+                                channel2_intr_enable(1);
+                        }
+                        if (ch->channel_id == VPIF_CHANNEL3_VIDEO ||
+                                        common->started == 2) {
+                                enable_channel3(1);
+                                channel3_intr_enable(1);
+                        }
+                }
+                mutex_unlock(&common->lock);
+        }
+
+        return 0;
+}
+
+static const struct dev_pm_ops vpif_pm = {
+        .suspend        = vpif_suspend,
+        .resume         = vpif_resume,
+};
+
+#define vpif_pm_ops (&vpif_pm)
+#else
+#define vpif_pm_ops NULL
+#endif
+
 static __refdata struct platform_driver vpif_driver = {
         .driver = {
                         .name   = "vpif_display",
                         .owner  = THIS_MODULE,
+                        .pm     = vpif_pm_ops,
         },
         .probe  = vpif_probe,
         .remove = vpif_remove,