From c5d7598c136e05bd398293158e4905153acb4f4b Mon Sep 17 00:00:00 2001
From: yxj <yxj@rock-chips.com>
Date: Thu, 2 May 2013 11:33:05 +0800
Subject: [PATCH] rk616:add lvds suspend support

---
 drivers/video/display/transmitter/rk616_vif.c | 53 +++++++++++++++++--
 drivers/video/display/transmitter/rk616_vif.h | 16 ++++++
 2 files changed, 64 insertions(+), 5 deletions(-)
 create mode 100644 drivers/video/display/transmitter/rk616_vif.h

diff --git a/drivers/video/display/transmitter/rk616_vif.c b/drivers/video/display/transmitter/rk616_vif.c
index 1101646fd812..6eb96ab315af 100644
--- a/drivers/video/display/transmitter/rk616_vif.c
+++ b/drivers/video/display/transmitter/rk616_vif.c
@@ -2,10 +2,10 @@
 #include <linux/init.h>
 #include <linux/platform_device.h>
 #include <linux/slab.h>
-#include <linux/mfd/rk616.h>
 #include <linux/rk_fb.h>
+#include "rk616_vif.h"
 
-struct mfd_rk616 *g_rk616;
+struct rk616_vif *g_vif;
 extern int rk616_pll_set_rate(struct mfd_rk616 *rk616,int id,u32 cfg_val,u32 frac);
 
 /*rk616 video interface config*/
@@ -663,27 +663,70 @@ static int rk616_display_router_cfg(struct mfd_rk616 *rk616,rk_screen *screen,bo
 int rk610_lcd_scaler_set_param(rk_screen *screen,bool enable )//enable:0 bypass 1: scale
 {
 	int ret;
-	struct mfd_rk616 *rk616 = g_rk616;
+	struct mfd_rk616 *rk616 = g_vif->rk616;
 	if(!rk616)
 	{
 		printk(KERN_ERR "%s:mfd rk616 is null!\n",__func__);
 		return -1;
 	}
+	g_vif->screen = screen;
 	ret = rk616_display_router_cfg(rk616,screen,enable);
 	return ret;
 }
 
+
+#if	defined(CONFIG_HAS_EARLYSUSPEND)
+static void rk616_vif_early_suspend(struct early_suspend *h)
+{
+	struct rk616_vif *vif = container_of(h, struct rk616_vif,early_suspend);
+	struct mfd_rk616 *rk616 = vif->rk616;
+	u32 val = 0;
+	int ret = 0;
+
+	val &= ~(LVDS_CH1_PWR_EN | LVDS_CH0_PWR_EN | LVDS_CBG_PWR_EN);
+	val |= LVDS_PLL_PWR_DN |(LVDS_CH1_PWR_EN << 16) | (LVDS_CH0_PWR_EN << 16) |
+		(LVDS_CBG_PWR_EN << 16) | (LVDS_PLL_PWR_DN << 16);
+	ret = rk616->write_dev(rk616,CRU_LVDS_CON0,&val);
+	
+}
+
+static void rk616_vif_late_resume(struct early_suspend *h)
+{
+	struct rk616_vif *vif = container_of(h, struct rk616_vif,early_suspend);
+	struct mfd_rk616 *rk616 = vif->rk616;
+	rk616_lvds_cfg(rk616,vif->screen);
+}
+
+#endif
+
 static int rk616_vif_probe(struct platform_device *pdev)
 {
+	struct rk616_vif *vif = NULL; 
+	struct mfd_rk616 *rk616 = NULL;
 
-	struct mfd_rk616 *rk616 = dev_get_drvdata(pdev->dev.parent);
+	vif = kzalloc(sizeof(struct rk616_vif),GFP_KERNEL);
+	if(!vif)
+	{
+		printk(KERN_ALERT "alloc for struct rk616_vif fail\n");
+		return  -ENOMEM;
+	}
+
+	rk616 = dev_get_drvdata(pdev->dev.parent);
 	if(!rk616)
 	{
 		dev_err(&pdev->dev,"null mfd device rk616!\n");
 		return -ENODEV;
 	}
 	else
-		g_rk616 = rk616;
+		g_vif = vif;
+		vif->rk616 = rk616;
+
+#ifdef CONFIG_HAS_EARLYSUSPEND
+	vif->early_suspend.suspend = rk616_vif_early_suspend;
+	vif->early_suspend.resume = rk616_vif_late_resume;
+    	vif->early_suspend.level = EARLY_SUSPEND_LEVEL_DISABLE_FB - 1;
+	register_early_suspend(&vif->early_suspend);
+#endif
 	
 
 	dev_info(&pdev->dev,"rk616 vif probe success!\n");
diff --git a/drivers/video/display/transmitter/rk616_vif.h b/drivers/video/display/transmitter/rk616_vif.h
new file mode 100644
index 000000000000..0f2a1bb2d664
--- /dev/null
+++ b/drivers/video/display/transmitter/rk616_vif.h
@@ -0,0 +1,16 @@
+#ifndef __RK616_VIF_H__
+#define __RK616_VIF_H__
+#include<linux/mfd/rk616.h>
+#include<linux/earlysuspend.h>
+#include<linux/rk_screen.h>
+
+
+struct rk616_vif {
+	struct mfd_rk616 *rk616;
+	rk_screen *screen;
+#ifdef CONFIG_HAS_EARLYSUSPEND
+	struct early_suspend early_suspend;
+#endif 
+};
+
+#endif
-- 
2.34.1