-#include <linux/fb.h>\r
-#include <linux/delay.h>\r
-#include <mach/gpio.h>\r
-#include <mach/iomux.h>\r
-#include <mach/board.h>\r
-#include "rk610_lcd.h"\r
-#include <linux/mfd/rk610_core.h>\r
-#include <linux/rk_fb.h>\r
-#include "../../rockchip/hdmi/rk_hdmi.h"\r
-\r
-static struct rk610_lcd_info *g_lcd_inf = NULL;\r
-//static int rk610_scaler_read_p0_reg(struct i2c_client *client, char reg, char *val)\r
-//{\r
- //return i2c_master_reg8_recv(client, reg, val, 1, 100*1000) > 0? 0: -EINVAL;\r
-//}\r
-\r
-static int rk610_scaler_write_p0_reg(struct i2c_client *client, char reg, char *val)\r
-{\r
- return i2c_master_reg8_send(client, reg, val, 1, 100*1000) > 0? 0: -EINVAL;\r
-}\r
-static void rk610_scaler_pll_enable(struct i2c_client *client)\r
-{\r
- char c;\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
-\r
- g_lcd_inf->scl_inf.pll_pwr = ENABLE;\r
- \r
- c = S_PLL_PWR(0)|S_PLL_RESET(0)|S_PLL_BYPASS(0);\r
- rk610_scaler_write_p0_reg(client, S_PLL_CON2, &c);\r
-}\r
-static void rk610_scaler_pll_disable(struct i2c_client *client)\r
-{\r
- char c;\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
- \r
- g_lcd_inf->scl_inf.pll_pwr = DISABLE;\r
-\r
- c = S_PLL_PWR(1) |S_PLL_RESET(0) |S_PLL_BYPASS(1);\r
- rk610_scaler_write_p0_reg(client, S_PLL_CON2, &c);\r
-}\r
-static void rk610_scaler_enable(struct i2c_client *client)\r
-{\r
- char c;\r
- bool den_inv = 0,hv_sync_inv = 0,clk_inv = 0;\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
- g_lcd_inf->scl_inf.scl_pwr = ENABLE;\r
- #if defined(CONFIG_HDMI_DUAL_DISP) || defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)\r
- if(g_lcd_inf->screen !=NULL){\r
- den_inv = g_lcd_inf->screen->s_den_inv;\r
- hv_sync_inv = g_lcd_inf->screen->s_hv_sync_inv;\r
- clk_inv = g_lcd_inf->screen->s_clk_inv;\r
- }\r
- #endif\r
- c= SCL_BYPASS(0) |SCL_DEN_INV(den_inv) |SCL_H_V_SYNC_INV(hv_sync_inv) |SCL_OUT_CLK_INV(clk_inv) |SCL_ENABLE(ENABLE); \r
- rk610_scaler_write_p0_reg(client, SCL_CON0, &c);\r
-}\r
-static void rk610_scaler_disable(struct i2c_client *client)\r
-{\r
- char c;\r
- bool den_inv = 0,hv_sync_inv = 0,clk_inv = 0;\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
- \r
- g_lcd_inf->scl_inf.scl_pwr = DISABLE;\r
- #if defined(CONFIG_HDMI_DUAL_DISP) || defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)\r
- if(g_lcd_inf->screen !=NULL){\r
- den_inv = g_lcd_inf->screen->s_den_inv;\r
- hv_sync_inv = g_lcd_inf->screen->s_hv_sync_inv;\r
- clk_inv = g_lcd_inf->screen->s_clk_inv;\r
- }\r
- #endif\r
- c= SCL_BYPASS(1) |SCL_DEN_INV(den_inv) |SCL_H_V_SYNC_INV(hv_sync_inv) |SCL_OUT_CLK_INV(clk_inv) |SCL_ENABLE(DISABLE); \r
- rk610_scaler_write_p0_reg(client, SCL_CON0, &c);\r
-}\r
-\r
-static int rk610_output_config(struct i2c_client *client,struct rk29fb_screen *screen,int mode)\r
-{\r
- char c=0;\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
- if(SCREEN_LVDS == screen->type){\r
- if(mode == LCD_OUT_SCL || mode == LCD_OUT_BYPASS){\r
- c = LVDS_OUT_CLK_PIN(0) |LVDS_OUT_CLK_PWR_PIN(1) |LVDS_PLL_PWR_PIN(0) \\r
- |LVDS_LANE_IN_FORMAT(DATA_D0_MSB) |LVDS_INPUT_SOURCE(FROM_LCD0_OR_SCL) \\r
- |LVDS_OUTPUT_FORMAT(screen->hw_format) | LVDS_BIASE_PWR(1); \r
- rk610_scaler_write_p0_reg(client, LVDS_CON0, &c);\r
- c = LVDS_OUT_ENABLE(0x0) |LVDS_TX_PWR_ENABLE(0x0); \r
- rk610_scaler_write_p0_reg(client, LVDS_CON1, &c);\r
- }\r
- else{\r
- c = LVDS_OUT_CLK_PIN(0) |LVDS_OUT_CLK_PWR_PIN(0) |LVDS_PLL_PWR_PIN(1) \\r
- |LVDS_LANE_IN_FORMAT(DATA_D0_MSB) |LVDS_INPUT_SOURCE(FROM_LCD0_OR_SCL) \\r
- |LVDS_OUTPUT_FORMAT(screen->hw_format) | LVDS_BIASE_PWR(0); \r
- rk610_scaler_write_p0_reg(client, LVDS_CON0, &c);\r
- c = LVDS_OUT_ENABLE(0xf) |LVDS_TX_PWR_ENABLE(0xf); \r
- rk610_scaler_write_p0_reg(client, LVDS_CON1, &c);\r
- \r
- }\r
- }else if(SCREEN_RGB == screen->type){\r
- if(mode == LCD_OUT_SCL || mode == LCD_OUT_BYPASS){\r
- c = LCD1_OUT_ENABLE(LCD1_AS_OUT) | LCD1_OUT_SRC((mode == LCD_OUT_SCL)?LCD1_FROM_SCL : LCD1_FROM_LCD0);\r
- rk610_scaler_write_p0_reg(client, LCD1_CON, &c);\r
- }\r
- else {\r
- c = LCD1_OUT_ENABLE(LCD1_AS_IN);\r
- rk610_scaler_write_p0_reg(client, LCD1_CON, &c);\r
- }\r
- }\r
- return 0;\r
-}\r
-#if defined(CONFIG_HDMI_DUAL_DISP) || defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)\r
-static int rk610_scaler_pll_set(struct i2c_client *client,struct rk29fb_screen *screen,u32 clkin )\r
-{\r
- char c=0;\r
- char M=0,N=0,OD=0;\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
- /***************SET SCALER PLL FROM CLKIN ,DIV 0*/\r
- if(screen->s_pixclock != 0){\r
- OD = (screen->s_pixclock)&0x3;\r
- N = (screen->s_pixclock >>4)&0xf;\r
- M = (screen->s_pixclock >>8)&0xff;\r
- }else {\r
- RK610_ERR(&client->dev,"RK610 Scaler pll not support rate \n");\r
- }\r
- c = S_PLL_FROM_DIV<<3 | S_PLL_DIV(0);\r
- rk610_scaler_write_p0_reg(client, CLOCK_CON0, &c);\r
- \r
- c = S_DIV_N(N)| S_DIV_OD(OD);\r
- rk610_scaler_write_p0_reg(client, S_PLL_CON0, &c);\r
- c = S_DIV_M(M);\r
- rk610_scaler_write_p0_reg(client, S_PLL_CON1, &c);\r
- rk610_scaler_pll_enable(client);\r
- return 0;\r
-}\r
-\r
-\r
-static int scale_hv_factor(struct i2c_client *client ,u32 Hin_act, u32 Hout_act, u32 Vin_act, u32 Vout_act)\r
- {\r
- char c;\r
- u32 hfactor_f,vfactor_f,scl_factor_f;\r
- int hfactor;\r
- int vfactor;\r
- struct scl_hv_info HV2;\r
- hfactor_f = ((Hin_act-1)*4096)/(Hout_act-1);\r
- if(hfactor_f==4096)\r
- {hfactor = 0x1000;}\r
- else if(hfactor_f>(int)hfactor_f)\r
- {hfactor = (int)hfactor_f+1;}\r
- else\r
- {hfactor = (int)hfactor_f;}\r
- \r
- scl_factor_f = Vin_act/Vout_act;\r
- if(scl_factor_f<2)\r
- {vfactor_f = ((Vin_act-1)*4096)/(Vout_act-1);}\r
- else\r
- {vfactor_f = ((Vin_act-2)*4096)/(Vout_act-1);} \r
- if(vfactor_f==4096)\r
- {vfactor = 0x1000;}\r
- else if(vfactor_f>(int)vfactor_f)\r
- {vfactor = (int)vfactor_f+1;}\r
- else\r
- {vfactor = (int)vfactor_f;}\r
- \r
- HV2.scl_h= hfactor;\r
- HV2.scl_v= vfactor; \r
- /* SCL FACTOR */\r
- c = SCL_H_FACTOR_LSB(HV2.scl_h);\r
- rk610_scaler_write_p0_reg(client, SCL_CON1, &c);\r
- c = SCL_H_FACTOR_MSB(HV2.scl_h);\r
- rk610_scaler_write_p0_reg(client, SCL_CON2, &c);\r
-\r
- c = SCL_V_FACTOR_LSB(HV2.scl_v);\r
- rk610_scaler_write_p0_reg(client, SCL_CON3, &c);\r
- c = SCL_V_FACTOR_MSB(HV2.scl_v);\r
- rk610_scaler_write_p0_reg(client, SCL_CON4, &c);\r
- return 0;\r
- }\r
-\r
-static int rk610_scaler_fator_config(struct i2c_client *client ,struct rk29fb_screen *screen)\r
-{\r
- switch(screen->hdmi_resolution){\r
- case HDMI_1920x1080p_60Hz:\r
- case HDMI_1920x1080p_50Hz:\r
- rk610_scaler_pll_set(client,screen,148500000);\r
- /***************set scaler factor********************/\r
- scale_hv_factor(client,1920,screen->x_res,1080,screen->y_res);\r
- break;\r
- case HDMI_1280x720p_60Hz:\r
- case HDMI_1280x720p_50Hz:\r
- rk610_scaler_pll_set(client,screen,74250000);\r
- /***************set scaler factor********************/\r
- scale_hv_factor(client,1280,screen->x_res,720,screen->y_res);\r
- break;\r
- case HDMI_720x576p_50Hz_16_9:\r
- case HDMI_720x576p_50Hz_4_3:\r
- rk610_scaler_pll_set(client,screen,27000000);\r
- /***************set scaler factor********************/\r
- scale_hv_factor(client,720,screen->x_res,576,screen->y_res);\r
- break;\r
- case HDMI_720x480p_60Hz_16_9:\r
- case HDMI_720x480p_60Hz_4_3:\r
- rk610_scaler_pll_set(client,screen,27000000);\r
- /***************set scaler factor********************/\r
- scale_hv_factor(client,720,screen->x_res,480,screen->y_res);\r
- break;\r
- default :\r
- RK610_ERR(&client->dev,"RK610 not support dual display at hdmi resolution=%d \n",screen->hdmi_resolution); \r
- return -1;\r
- break;\r
- }\r
- return 0;\r
-}\r
-static int rk610_scaler_output_timing_config(struct i2c_client *client,struct rk29fb_screen *screen)\r
-{\r
- char c;\r
- int h_st = screen->s_hsync_st;\r
- int hs_end = screen->s_hsync_len;\r
- int h_act_st = hs_end + screen->s_left_margin;\r
- int xres = screen->x_res;\r
- int h_act_end = h_act_st + xres;\r
- int h_total = h_act_end + screen->s_right_margin;\r
- int v_st = screen->s_vsync_st;\r
- int vs_end = screen->s_vsync_len;\r
- int v_act_st = vs_end + screen->s_upper_margin;\r
- int yres = screen->y_res; \r
- int v_act_end = v_act_st + yres;\r
- int v_total = v_act_end + screen->s_lower_margin;\r
-\r
- /* SCL display Frame start point */\r
- c = SCL_DSP_HST_LSB(h_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON5, &c);\r
- c = SCL_DSP_HST_MSB(h_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON6, &c);\r
-\r
- c = SCL_DSP_VST_LSB(v_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON7, &c);\r
- c = SCL_DSP_VST_MSB(v_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON8, &c);\r
- /* SCL output timing */\r
-\r
- c = SCL_DSP_HTOTAL_LSB(h_total);\r
- rk610_scaler_write_p0_reg(client, SCL_CON9, &c);\r
- c = SCL_DSP_HTOTAL_MSB(h_total);\r
- rk610_scaler_write_p0_reg(client, SCL_CON10, &c);\r
-\r
- c = SCL_DSP_HS_END(hs_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON11, &c);\r
-\r
- c = SCL_DSP_HACT_ST_LSB(h_act_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON12, &c);\r
- c = SCL_DSP_HACT_ST_MSB(h_act_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON13, &c);\r
-\r
- c = SCL_DSP_HACT_END_LSB(h_act_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON14, &c);\r
- c = SCL_DSP_HACT_END_MSB(h_act_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON15, &c);\r
-\r
- c = SCL_DSP_VTOTAL_LSB(v_total);\r
- rk610_scaler_write_p0_reg(client, SCL_CON16, &c);\r
- c = SCL_DSP_VTOTAL_MSB(v_total);\r
- rk610_scaler_write_p0_reg(client, SCL_CON17, &c);\r
-\r
- c = SCL_DSP_VS_END(vs_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON18, &c);\r
-\r
- c = SCL_DSP_VACT_ST(v_act_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON19, &c);\r
-\r
- c = SCL_DSP_VACT_END_LSB(v_act_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON20, &c);\r
- c = SCL_DSP_VACT_END_MSB(v_act_end); \r
- rk610_scaler_write_p0_reg(client, SCL_CON21, &c);\r
- \r
- c = SCL_H_BORD_ST_LSB(h_act_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON22, &c);\r
- c = SCL_H_BORD_ST_MSB(h_act_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON23, &c);\r
-\r
- c = SCL_H_BORD_END_LSB(h_act_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON24, &c);\r
- c = SCL_H_BORD_END_MSB(h_act_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON25, &c);\r
-\r
- c = SCL_V_BORD_ST(v_act_st);\r
- rk610_scaler_write_p0_reg(client, SCL_CON26, &c);\r
-\r
- c = SCL_V_BORD_END_LSB(v_act_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON27, &c);\r
- c = SCL_V_BORD_END_MSB(v_act_end);\r
- rk610_scaler_write_p0_reg(client, SCL_CON28, &c);\r
- \r
- return 0;\r
-}\r
-static int rk610_scaler_chg(struct i2c_client *client ,struct rk29fb_screen *screen)\r
-{\r
-\r
- RK610_DBG(&client->dev,"%s screen->hdmi_resolution=%d\n",__FUNCTION__,screen->hdmi_resolution);\r
- rk610_scaler_fator_config(client,screen);\r
- rk610_scaler_enable(client);\r
- rk610_scaler_output_timing_config(client,screen); \r
- \r
- return 0;\r
-\r
-}\r
-#endif\r
-static int rk610_lcd_scaler_bypass(struct i2c_client *client,bool enable)//enable:0 bypass 1: scale\r
-{\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
- \r
- rk610_scaler_disable(client); \r
- rk610_scaler_pll_disable(client);\r
- \r
- return 0;\r
-}\r
-\r
-#ifdef CONFIG_HAS_EARLYSUSPEND\r
-static void rk610_lcd_early_suspend(struct early_suspend *h)\r
-{\r
- struct i2c_client *client = g_lcd_inf->client;\r
- char c;\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
- if(g_lcd_inf->screen != NULL){\r
- rk610_output_config(client,g_lcd_inf->screen,LCD_OUT_DISABLE);\r
- }\r
-\r
- if(ENABLE == g_lcd_inf->scl_inf.scl_pwr){\r
- c= SCL_BYPASS(1) |SCL_DEN_INV(0) |SCL_H_V_SYNC_INV(0) |SCL_OUT_CLK_INV(0) |SCL_ENABLE(DISABLE); \r
- rk610_scaler_write_p0_reg(client, SCL_CON0, &c);\r
- }\r
- if(ENABLE == g_lcd_inf->scl_inf.pll_pwr ){\r
- c = S_PLL_PWR(1) |S_PLL_RESET(0) |S_PLL_BYPASS(1);\r
- rk610_scaler_write_p0_reg(client, S_PLL_CON2, &c);\r
- }\r
-}\r
-\r
-static void rk610_lcd_early_resume(struct early_suspend *h)\r
-{\r
- struct i2c_client *client = g_lcd_inf->client;\r
- char c;\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
-\r
- if(g_lcd_inf->screen != NULL){\r
- rk610_output_config(client,g_lcd_inf->screen,g_lcd_inf->disp_mode);\r
- }\r
- if(ENABLE == g_lcd_inf->scl_inf.scl_pwr){\r
- c= SCL_BYPASS(0) |SCL_DEN_INV(0) |SCL_H_V_SYNC_INV(0) |SCL_OUT_CLK_INV(0) |SCL_ENABLE(ENABLE); \r
- rk610_scaler_write_p0_reg(client, SCL_CON0, &c);\r
- }\r
- if(ENABLE == g_lcd_inf->scl_inf.pll_pwr ){\r
- c = S_PLL_PWR(1) |S_PLL_RESET(0) |S_PLL_BYPASS(1);\r
- rk610_scaler_write_p0_reg(client, S_PLL_CON2, &c);\r
- }\r
-}\r
-#endif\r
-int rk610_lcd_scaler_set_param(struct rk29fb_screen *screen,bool enable )//enable:0 bypass 1: scale\r
-{\r
- int ret=0;\r
- struct i2c_client *client = g_lcd_inf->client;\r
- if(client == NULL){\r
- printk("%s client == NULL FAIL\n",__FUNCTION__);\r
- return -1;\r
- }\r
- if(screen == NULL){\r
- printk("%s screen == NULL FAIL\n",__FUNCTION__);\r
- return -1;\r
- }\r
- RK610_DBG(&client->dev,"%s \n",__FUNCTION__);\r
- \r
- g_lcd_inf->screen = screen;\r
- \r
-#if defined(CONFIG_HDMI_DUAL_DISP) || defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)\r
- if(enable == 1){\r
- g_lcd_inf->disp_mode = LCD_OUT_SCL;\r
- rk610_output_config(client,screen,LCD_OUT_SCL);\r
- ret = rk610_scaler_chg(client,screen);\r
- }\r
- else \r
-#endif\r
- {\r
- g_lcd_inf->disp_mode = LCD_OUT_BYPASS;\r
- rk610_output_config(client,screen,LCD_OUT_BYPASS);\r
- ret = rk610_lcd_scaler_bypass(client,enable);\r
- }\r
- return ret;\r
-}\r
-int rk610_lcd_init(struct rk610_core_info *rk610_core_info)\r
-{\r
- if(rk610_core_info->client == NULL){\r
- printk("%s client == NULL FAIL\n",__FUNCTION__);\r
- return -1;\r
- }\r
- RK610_DBG(&rk610_core_info->client->dev,"%s \n",__FUNCTION__);\r
-\r
- g_lcd_inf = kmalloc(sizeof(struct rk610_lcd_info), GFP_KERNEL);\r
- if(!g_lcd_inf)\r
+#include <linux/fb.h>
+#include <linux/delay.h>
+#include <mach/gpio.h>
+#include <mach/iomux.h>
+#include <mach/board.h>
+#include "rk610_lcd.h"
+#include <linux/mfd/rk610_core.h>
+#include <linux/rk_fb.h>
+#include "../hdmi/rk_hdmi.h"
+
+static struct rk610_lcd_info *g_lcd_inf = NULL;
+//static int rk610_scaler_read_p0_reg(struct i2c_client *client, char reg, char *val)
+//{
+ //return i2c_master_reg8_recv(client, reg, val, 1, 100*1000) > 0? 0: -EINVAL;
+//}
+
+static int rk610_scaler_write_p0_reg(struct i2c_client *client, char reg, char *val)
+{
+ return i2c_master_reg8_send(client, reg, val, 1, 100*1000) > 0? 0: -EINVAL;
+}
+static void rk610_scaler_pll_enable(struct i2c_client *client)
+{
+ char c;
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+
+ g_lcd_inf->scl_inf.pll_pwr = ENABLE;
+
+ c = S_PLL_PWR(0)|S_PLL_RESET(0)|S_PLL_BYPASS(0);
+ rk610_scaler_write_p0_reg(client, S_PLL_CON2, &c);
+}
+static void rk610_scaler_pll_disable(struct i2c_client *client)
+{
+ char c;
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+
+ g_lcd_inf->scl_inf.pll_pwr = DISABLE;
+
+ c = S_PLL_PWR(1) |S_PLL_RESET(0) |S_PLL_BYPASS(1);
+ rk610_scaler_write_p0_reg(client, S_PLL_CON2, &c);
+}
+static void rk610_scaler_enable(struct i2c_client *client)
+{
+ char c;
+ bool den_inv = 0,hv_sync_inv = 0,clk_inv = 0;
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+ g_lcd_inf->scl_inf.scl_pwr = ENABLE;
+ #if defined(CONFIG_HDMI_DUAL_DISP) || defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)
+ if(g_lcd_inf->screen !=NULL){
+ den_inv = g_lcd_inf->screen->s_den_inv;
+ hv_sync_inv = g_lcd_inf->screen->s_hv_sync_inv;
+ clk_inv = g_lcd_inf->screen->s_clk_inv;
+ }
+ #endif
+ c= SCL_BYPASS(0) |SCL_DEN_INV(den_inv) |SCL_H_V_SYNC_INV(hv_sync_inv) |SCL_OUT_CLK_INV(clk_inv) |SCL_ENABLE(ENABLE);
+ rk610_scaler_write_p0_reg(client, SCL_CON0, &c);
+}
+static void rk610_scaler_disable(struct i2c_client *client)
+{
+ char c;
+ bool den_inv = 0,hv_sync_inv = 0,clk_inv = 0;
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+
+ g_lcd_inf->scl_inf.scl_pwr = DISABLE;
+ #if defined(CONFIG_HDMI_DUAL_DISP) || defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)
+ if(g_lcd_inf->screen !=NULL){
+ den_inv = g_lcd_inf->screen->s_den_inv;
+ hv_sync_inv = g_lcd_inf->screen->s_hv_sync_inv;
+ clk_inv = g_lcd_inf->screen->s_clk_inv;
+ }
+ #endif
+ c= SCL_BYPASS(1) |SCL_DEN_INV(den_inv) |SCL_H_V_SYNC_INV(hv_sync_inv) |SCL_OUT_CLK_INV(clk_inv) |SCL_ENABLE(DISABLE);
+ rk610_scaler_write_p0_reg(client, SCL_CON0, &c);
+}
+
+static int rk610_output_config(struct i2c_client *client,struct rk_screen *screen,int mode)
+{
+ char c=0;
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+ if(SCREEN_LVDS == screen->type){
+ if(mode == LCD_OUT_SCL || mode == LCD_OUT_BYPASS){
+ c = LVDS_OUT_CLK_PIN(0) |LVDS_OUT_CLK_PWR_PIN(1) |LVDS_PLL_PWR_PIN(0) \
+ |LVDS_LANE_IN_FORMAT(DATA_D0_MSB) \
+ |LVDS_OUTPUT_FORMAT(screen->lvds_format) | LVDS_BIASE_PWR(1);
+#if defined(CONFIG_DUAL_LCDC_DUAL_DISP_IN_KERNEL) && defined(CONFIG_HDMI_RK610)
+ c |= LVDS_INPUT_SOURCE(FROM_LCD1);
+#else
+ c |= LVDS_INPUT_SOURCE(FROM_LCD0_OR_SCL);
+#endif
+ rk610_scaler_write_p0_reg(client, LVDS_CON0, &c);
+ c = LCD1_OUT_ENABLE(LCD1_AS_IN);
+ rk610_scaler_write_p0_reg(client, LCD1_CON, &c);
+ c = LVDS_OUT_ENABLE(0x0) |LVDS_TX_PWR_ENABLE(0x0);
+ rk610_scaler_write_p0_reg(client, LVDS_CON1, &c);
+ }
+ else{
+ c = LVDS_OUT_CLK_PIN(0) |LVDS_OUT_CLK_PWR_PIN(0) |LVDS_PLL_PWR_PIN(1) \
+ |LVDS_LANE_IN_FORMAT(DATA_D0_MSB) \
+ |LVDS_OUTPUT_FORMAT(screen->lvds_format) | LVDS_BIASE_PWR(0);
+#if defined(CONFIG_DUAL_LCDC_DUAL_DISP_IN_KERNEL) && defined(CONFIG_HDMI_RK610)
+ c |= LVDS_INPUT_SOURCE(FROM_LCD1);
+#else
+ c |= LVDS_INPUT_SOURCE(FROM_LCD0_OR_SCL);
+#endif
+ rk610_scaler_write_p0_reg(client, LVDS_CON0, &c);
+ c = LCD1_OUT_ENABLE(LCD1_AS_IN);
+ rk610_scaler_write_p0_reg(client, LCD1_CON, &c);
+ c = LVDS_OUT_ENABLE(0xf) |LVDS_TX_PWR_ENABLE(0xf);
+ rk610_scaler_write_p0_reg(client, LVDS_CON1, &c);
+
+ }
+ }else if(SCREEN_RGB == screen->type){
+ if(mode == LCD_OUT_SCL || mode == LCD_OUT_BYPASS){
+ c = LCD1_OUT_ENABLE(LCD1_AS_OUT) | LCD1_OUT_SRC((mode == LCD_OUT_SCL)?LCD1_FROM_SCL : LCD1_FROM_LCD0);
+ rk610_scaler_write_p0_reg(client, LCD1_CON, &c);
+ }
+ else {
+ c = LCD1_OUT_ENABLE(LCD1_AS_IN);
+ rk610_scaler_write_p0_reg(client, LCD1_CON, &c);
+ }
+ }
+ return 0;
+}
+#if defined(CONFIG_HDMI_DUAL_DISP) || defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)
+static int rk610_scaler_pll_set(struct i2c_client *client,struct rk_screen *screen,u32 clkin )
+{
+ char c=0;
+ char M=0,N=0,OD=0;
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+ /***************SET SCALER PLL FROM CLKIN ,DIV 0*/
+ if(screen->s_pixclock != 0){
+ OD = (screen->s_pixclock)&0x3;
+ N = (screen->s_pixclock >>4)&0xf;
+ M = (screen->s_pixclock >>8)&0xff;
+ }else {
+ RK610_ERR(&client->dev,"RK610 Scaler pll not support rate \n");
+ }
+ c = S_PLL_FROM_DIV<<3 | S_PLL_DIV(0);
+ rk610_scaler_write_p0_reg(client, CLOCK_CON0, &c);
+
+ c = S_DIV_N(N)| S_DIV_OD(OD);
+ rk610_scaler_write_p0_reg(client, S_PLL_CON0, &c);
+ c = S_DIV_M(M);
+ rk610_scaler_write_p0_reg(client, S_PLL_CON1, &c);
+ rk610_scaler_pll_enable(client);
+ return 0;
+}
+
+
+static int scale_hv_factor(struct i2c_client *client ,u32 Hin_act, u32 Hout_act, u32 Vin_act, u32 Vout_act)
+ {
+ char c;
+ u32 hfactor_f,vfactor_f,scl_factor_f;
+ int hfactor;
+ int vfactor;
+ struct scl_hv_info HV2;
+ hfactor_f = ((Hin_act-1)*4096)/(Hout_act-1);
+ if(hfactor_f==4096)
+ {hfactor = 0x1000;}
+ else if(hfactor_f>(int)hfactor_f)
+ {hfactor = (int)hfactor_f+1;}
+ else
+ {hfactor = (int)hfactor_f;}
+
+ scl_factor_f = Vin_act/Vout_act;
+ if(scl_factor_f<2)
+ {vfactor_f = ((Vin_act-1)*4096)/(Vout_act-1);}
+ else
+ {vfactor_f = ((Vin_act-2)*4096)/(Vout_act-1);}
+ if(vfactor_f==4096)
+ {vfactor = 0x1000;}
+ else if(vfactor_f>(int)vfactor_f)
+ {vfactor = (int)vfactor_f+1;}
+ else
+ {vfactor = (int)vfactor_f;}
+
+ HV2.scl_h= hfactor;
+ HV2.scl_v= vfactor;
+ /* SCL FACTOR */
+ c = SCL_H_FACTOR_LSB(HV2.scl_h);
+ rk610_scaler_write_p0_reg(client, SCL_CON1, &c);
+ c = SCL_H_FACTOR_MSB(HV2.scl_h);
+ rk610_scaler_write_p0_reg(client, SCL_CON2, &c);
+
+ c = SCL_V_FACTOR_LSB(HV2.scl_v);
+ rk610_scaler_write_p0_reg(client, SCL_CON3, &c);
+ c = SCL_V_FACTOR_MSB(HV2.scl_v);
+ rk610_scaler_write_p0_reg(client, SCL_CON4, &c);
+ return 0;
+ }
+
+static int rk610_scaler_fator_config(struct i2c_client *client ,struct rk_screen *screen)
+{
+ switch(screen->hdmi_resolution){
+ case HDMI_1920x1080p_60Hz:
+ case HDMI_1920x1080p_50Hz:
+ rk610_scaler_pll_set(client,screen,148500000);
+ /***************set scaler factor********************/
+ scale_hv_factor(client,1920,screen->x_res,1080,screen->y_res);
+ break;
+ case HDMI_1280x720p_60Hz:
+ case HDMI_1280x720p_50Hz:
+ rk610_scaler_pll_set(client,screen,74250000);
+ /***************set scaler factor********************/
+ scale_hv_factor(client,1280,screen->x_res,720,screen->y_res);
+ break;
+ case HDMI_720x576p_50Hz_16_9:
+ case HDMI_720x576p_50Hz_4_3:
+ rk610_scaler_pll_set(client,screen,27000000);
+ /***************set scaler factor********************/
+ scale_hv_factor(client,720,screen->x_res,576,screen->y_res);
+ break;
+ case HDMI_720x480p_60Hz_16_9:
+ case HDMI_720x480p_60Hz_4_3:
+ rk610_scaler_pll_set(client,screen,27000000);
+ /***************set scaler factor********************/
+ scale_hv_factor(client,720,screen->x_res,480,screen->y_res);
+ break;
+ default :
+ RK610_ERR(&client->dev,"RK610 not support dual display at hdmi resolution=%d \n",screen->hdmi_resolution);
+ return -1;
+ break;
+ }
+ return 0;
+}
+static int rk610_scaler_output_timing_config(struct i2c_client *client,struct rk_screen *screen)
+{
+ char c;
+ int h_st = screen->s_hsync_st;
+ int hs_end = screen->s_hsync_len;
+ int h_act_st = hs_end + screen->s_left_margin;
+ int xres = screen->x_res;
+ int h_act_end = h_act_st + xres;
+ int h_total = h_act_end + screen->s_right_margin;
+ int v_st = screen->s_vsync_st;
+ int vs_end = screen->s_vsync_len;
+ int v_act_st = vs_end + screen->s_upper_margin;
+ int yres = screen->y_res;
+ int v_act_end = v_act_st + yres;
+ int v_total = v_act_end + screen->s_lower_margin;
+
+ /* SCL display Frame start point */
+ c = SCL_DSP_HST_LSB(h_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON5, &c);
+ c = SCL_DSP_HST_MSB(h_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON6, &c);
+
+ c = SCL_DSP_VST_LSB(v_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON7, &c);
+ c = SCL_DSP_VST_MSB(v_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON8, &c);
+ /* SCL output timing */
+
+ c = SCL_DSP_HTOTAL_LSB(h_total);
+ rk610_scaler_write_p0_reg(client, SCL_CON9, &c);
+ c = SCL_DSP_HTOTAL_MSB(h_total);
+ rk610_scaler_write_p0_reg(client, SCL_CON10, &c);
+
+ c = SCL_DSP_HS_END(hs_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON11, &c);
+
+ c = SCL_DSP_HACT_ST_LSB(h_act_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON12, &c);
+ c = SCL_DSP_HACT_ST_MSB(h_act_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON13, &c);
+
+ c = SCL_DSP_HACT_END_LSB(h_act_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON14, &c);
+ c = SCL_DSP_HACT_END_MSB(h_act_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON15, &c);
+
+ c = SCL_DSP_VTOTAL_LSB(v_total);
+ rk610_scaler_write_p0_reg(client, SCL_CON16, &c);
+ c = SCL_DSP_VTOTAL_MSB(v_total);
+ rk610_scaler_write_p0_reg(client, SCL_CON17, &c);
+
+ c = SCL_DSP_VS_END(vs_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON18, &c);
+
+ c = SCL_DSP_VACT_ST(v_act_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON19, &c);
+
+ c = SCL_DSP_VACT_END_LSB(v_act_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON20, &c);
+ c = SCL_DSP_VACT_END_MSB(v_act_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON21, &c);
+
+ c = SCL_H_BORD_ST_LSB(h_act_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON22, &c);
+ c = SCL_H_BORD_ST_MSB(h_act_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON23, &c);
+
+ c = SCL_H_BORD_END_LSB(h_act_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON24, &c);
+ c = SCL_H_BORD_END_MSB(h_act_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON25, &c);
+
+ c = SCL_V_BORD_ST(v_act_st);
+ rk610_scaler_write_p0_reg(client, SCL_CON26, &c);
+
+ c = SCL_V_BORD_END_LSB(v_act_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON27, &c);
+ c = SCL_V_BORD_END_MSB(v_act_end);
+ rk610_scaler_write_p0_reg(client, SCL_CON28, &c);
+
+ return 0;
+}
+static int rk610_scaler_chg(struct i2c_client *client ,struct rk_screen *screen)
+{
+
+ RK610_DBG(&client->dev,"%s screen->hdmi_resolution=%d\n",__FUNCTION__,screen->hdmi_resolution);
+ rk610_scaler_fator_config(client,screen);
+ rk610_scaler_enable(client);
+ rk610_scaler_output_timing_config(client,screen);
+
+ return 0;
+
+}
+#endif
+static int rk610_lcd_scaler_bypass(struct i2c_client *client,bool enable)//enable:0 bypass 1: scale
+{
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+
+ rk610_scaler_disable(client);
+ rk610_scaler_pll_disable(client);
+
+ return 0;
+}
+
+#ifdef CONFIG_HAS_EARLYSUSPEND
+static void rk610_lcd_early_suspend(struct early_suspend *h)
+{
+ struct i2c_client *client = g_lcd_inf->client;
+ char c;
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+ if(g_lcd_inf->screen != NULL){
+ rk610_output_config(client,g_lcd_inf->screen,LCD_OUT_DISABLE);
+ }
+
+ if(ENABLE == g_lcd_inf->scl_inf.scl_pwr){
+ c= SCL_BYPASS(1) |SCL_DEN_INV(0) |SCL_H_V_SYNC_INV(0) |SCL_OUT_CLK_INV(0) |SCL_ENABLE(DISABLE);
+ rk610_scaler_write_p0_reg(client, SCL_CON0, &c);
+ }
+ if(ENABLE == g_lcd_inf->scl_inf.pll_pwr ){
+ c = S_PLL_PWR(1) |S_PLL_RESET(0) |S_PLL_BYPASS(1);
+ rk610_scaler_write_p0_reg(client, S_PLL_CON2, &c);
+ }
+}
+
+static void rk610_lcd_early_resume(struct early_suspend *h)
+{
+ struct i2c_client *client = g_lcd_inf->client;
+ char c;
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+
+ if(g_lcd_inf->screen != NULL){
+ rk610_output_config(client,g_lcd_inf->screen,g_lcd_inf->disp_mode);
+ }
+ if(ENABLE == g_lcd_inf->scl_inf.scl_pwr){
+ c= SCL_BYPASS(0) |SCL_DEN_INV(0) |SCL_H_V_SYNC_INV(0) |SCL_OUT_CLK_INV(0) |SCL_ENABLE(ENABLE);
+ rk610_scaler_write_p0_reg(client, SCL_CON0, &c);
+ }
+ if(ENABLE == g_lcd_inf->scl_inf.pll_pwr ){
+ c = S_PLL_PWR(1) |S_PLL_RESET(0) |S_PLL_BYPASS(1);
+ rk610_scaler_write_p0_reg(client, S_PLL_CON2, &c);
+ }
+}
+#endif
+int rk610_lcd_scaler_set_param(struct rk_screen *screen,bool enable )//enable:0 bypass 1: scale
+{
+ int ret=0;
+ struct i2c_client *client = g_lcd_inf->client;
+ if(client == NULL){
+ printk("%s client == NULL FAIL\n",__FUNCTION__);
+ return -1;
+ }
+ if(screen == NULL){
+ printk("%s screen == NULL FAIL\n",__FUNCTION__);
+ return -1;
+ }
+ RK610_DBG(&client->dev,"%s \n",__FUNCTION__);
+
+ g_lcd_inf->screen = screen;
+
+#if defined(CONFIG_HDMI_DUAL_DISP) || defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)
+ if(enable == 1){
+ g_lcd_inf->disp_mode = LCD_OUT_SCL;
+ rk610_output_config(client,screen,LCD_OUT_SCL);
+ ret = rk610_scaler_chg(client,screen);
+ }
+ else
+#endif
+ {
+ g_lcd_inf->disp_mode = LCD_OUT_BYPASS;
+ rk610_output_config(client,screen,LCD_OUT_BYPASS);
+ ret = rk610_lcd_scaler_bypass(client,enable);
+ }
+ return ret;
+}
+int rk610_lcd_init(struct rk610_core_info *rk610_core_info)
+{
+ if(rk610_core_info->client == NULL){
+ printk("%s client == NULL FAIL\n",__FUNCTION__);
+ return -1;
+ }
+ RK610_DBG(&rk610_core_info->client->dev,"%s \n",__FUNCTION__);
+
+ g_lcd_inf = kmalloc(sizeof(struct rk610_lcd_info), GFP_KERNEL);
+ if(!g_lcd_inf)
{
- dev_err(&rk610_core_info->client->dev, ">> rk610 inf kmalloc fail!");\r
- return -ENOMEM;\r
- }\r
- memset(g_lcd_inf, 0, sizeof(struct rk610_lcd_info));\r
-\r
- g_lcd_inf->client= rk610_core_info->client;\r
- \r
- rk610_core_info->lcd_pdata = (void *)g_lcd_inf;\r
-#ifdef CONFIG_HAS_EARLYSUSPEND\r
- g_lcd_inf->early_suspend.suspend = rk610_lcd_early_suspend;\r
- g_lcd_inf->early_suspend.resume = rk610_lcd_early_resume;\r
+ dev_err(&rk610_core_info->client->dev, ">> rk610 inf kmalloc fail!");
+ return -ENOMEM;
+ }
+ memset(g_lcd_inf, 0, sizeof(struct rk610_lcd_info));
+
+ g_lcd_inf->client= rk610_core_info->client;
+
+ rk610_core_info->lcd_pdata = (void *)g_lcd_inf;
+#ifdef CONFIG_HAS_EARLYSUSPEND
+ g_lcd_inf->early_suspend.suspend = rk610_lcd_early_suspend;
+ g_lcd_inf->early_suspend.resume = rk610_lcd_early_resume;
g_lcd_inf->early_suspend.level = EARLY_SUSPEND_LEVEL_DISABLE_FB- 1;
- register_early_suspend(&g_lcd_inf->early_suspend);\r
-#endif\r
- g_lcd_inf->scl_inf.pll_pwr = DISABLE;\r
- g_lcd_inf->scl_inf.scl_pwr = DISABLE;\r
- g_lcd_inf->disp_mode = LCD_OUT_BYPASS;\r
- return 0;\r
-}\r
+ register_early_suspend(&g_lcd_inf->early_suspend);
+#endif
+ g_lcd_inf->scl_inf.pll_pwr = DISABLE;
+ g_lcd_inf->scl_inf.scl_pwr = DISABLE;
+ g_lcd_inf->disp_mode = LCD_OUT_BYPASS;
+ return 0;
+}
+
+static int rk610_lcd_probe(struct platform_device *pdev)
+{
+ struct rk610_core_info *core_info = NULL;
+ rk_screen *screen = NULL;
+
+ core_info = dev_get_drvdata(pdev->dev.parent);
+ if(!core_info)
+ {
+ dev_err(&pdev->dev,"rk610 core info is null\n");
+ return -ENODEV;
+ }
+ screen = rk_fb_get_prmry_screen();
+ if(!screen)
+ {
+ dev_err(&pdev->dev,"the fb prmry screen is null!\n");
+ return -ENODEV;
+ }
+
+#if defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)
+ screen->sscreen_set = rk610_lcd_scaler_set_param;
+#endif
+ rk610_lcd_init(core_info);
+ rk610_lcd_scaler_set_param(screen,0);
+
+ return 0;
+
+}
+static int rk610_lcd_remove(struct platform_device *pdev)
+{
+
+ return 0;
+}
+
+static void rk610_lcd_shutdown(struct platform_device *pdev)
+{
+
+ return;
+}
+
+static struct platform_driver rk610_lcd_driver = {
+ .driver = {
+ .name = "rk610-lcd",
+ .owner = THIS_MODULE,
+ },
+ .probe = rk610_lcd_probe,
+ .remove = rk610_lcd_remove,
+ .shutdown = rk610_lcd_shutdown,
+};
+
+static int __init rk610_lcd_module_init(void)
+{
+ return platform_driver_register(&rk610_lcd_driver);
+}
+fs_initcall(rk610_lcd_module_init);
+static void __exit rk610_lcd_exit(void)
+{
+ platform_driver_unregister(&rk610_lcd_driver);
+}
+module_exit(rk610_lcd_exit);
+
projects / firefly-linux-kernel-4.4.55.git / blobdiff