1 /* Copyright (c) 2008-2009, Code Aurora Forum. All rights reserved.
3 * This program is free software; you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License version 2 and
5 * only version 2 as published by the Free Software Foundation.
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
12 * You should have received a copy of the GNU General Public License
13 * along with this program; if not, write to the Free Software
14 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
18 #include <linux/module.h>
19 #include <linux/kernel.h>
20 #include <linux/sched.h>
21 #include <linux/time.h>
22 #include <linux/init.h>
23 #include <linux/interrupt.h>
24 #include <linux/spinlock.h>
25 #include <linux/delay.h>
26 #include <mach/hardware.h>
29 #include <asm/system.h>
30 #include <asm/mach-types.h>
31 #include <linux/semaphore.h>
32 #include <linux/uaccess.h>
33 #include <linux/clk.h>
34 #include <linux/platform_device.h>
35 #include <linux/pm_qos_params.h>
39 static int lcdc_probe(struct platform_device
*pdev
);
40 static int lcdc_remove(struct platform_device
*pdev
);
42 static int lcdc_off(struct platform_device
*pdev
);
43 static int lcdc_on(struct platform_device
*pdev
);
45 static struct platform_device
*pdev_list
[MSM_FB_MAX_DEV_LIST
];
46 static int pdev_list_cnt
;
48 static struct clk
*mdp_lcdc_pclk_clk
;
49 static struct clk
*mdp_lcdc_pad_pclk_clk
;
51 int mdp_lcdc_pclk_clk_rate
;
52 int mdp_lcdc_pad_pclk_clk_rate
;
54 static struct platform_driver lcdc_driver
= {
56 .remove
= lcdc_remove
,
65 static struct lcdc_platform_data
*lcdc_pdata
;
67 static int lcdc_off(struct platform_device
*pdev
)
71 ret
= panel_next_off(pdev
);
73 clk_disable(mdp_lcdc_pclk_clk
);
74 clk_disable(mdp_lcdc_pad_pclk_clk
);
76 if (lcdc_pdata
&& lcdc_pdata
->lcdc_power_save
)
77 lcdc_pdata
->lcdc_power_save(0);
79 if (lcdc_pdata
&& lcdc_pdata
->lcdc_gpio_config
)
80 ret
= lcdc_pdata
->lcdc_gpio_config(0);
82 // pm_qos_update_requirement(PM_QOS_SYSTEM_BUS_FREQ , "lcdc",
83 // PM_QOS_DEFAULT_VALUE);
88 static int lcdc_on(struct platform_device
*pdev
)
91 struct msm_fb_data_type
*mfd
;
92 unsigned long panel_pixclock_freq
, pm_qos_freq
;
94 mfd
= platform_get_drvdata(pdev
);
95 panel_pixclock_freq
= mfd
->fbi
->var
.pixclock
;
97 if (panel_pixclock_freq
> 58000000)
98 /* pm_qos_freq should be in Khz */
99 pm_qos_freq
= panel_pixclock_freq
/ 1000 ;
103 // pm_qos_update_requirement(PM_QOS_SYSTEM_BUS_FREQ , "lcdc",
105 mfd
= platform_get_drvdata(pdev
);
107 clk_enable(mdp_lcdc_pclk_clk
);
108 clk_enable(mdp_lcdc_pad_pclk_clk
);
110 if (lcdc_pdata
&& lcdc_pdata
->lcdc_power_save
)
111 lcdc_pdata
->lcdc_power_save(1);
112 if (lcdc_pdata
&& lcdc_pdata
->lcdc_gpio_config
)
113 ret
= lcdc_pdata
->lcdc_gpio_config(1);
115 clk_set_rate(mdp_lcdc_pclk_clk
, mfd
->fbi
->var
.pixclock
);
116 clk_set_rate(mdp_lcdc_pad_pclk_clk
, mfd
->fbi
->var
.pixclock
);
117 mdp_lcdc_pclk_clk_rate
= clk_get_rate(mdp_lcdc_pclk_clk
);
118 mdp_lcdc_pad_pclk_clk_rate
= clk_get_rate(mdp_lcdc_pad_pclk_clk
);
120 ret
= panel_next_on(pdev
);
124 static int lcdc_probe(struct platform_device
*pdev
)
126 struct msm_fb_data_type
*mfd
;
128 struct platform_device
*mdp_dev
= NULL
;
129 struct msm_fb_panel_data
*pdata
= NULL
;
133 lcdc_pdata
= pdev
->dev
.platform_data
;
137 mfd
= platform_get_drvdata(pdev
);
142 if (mfd
->key
!= MFD_KEY
)
145 if (pdev_list_cnt
>= MSM_FB_MAX_DEV_LIST
)
148 mdp_dev
= platform_device_alloc("mdp", pdev
->id
);
153 * link to the latest pdev
156 mfd
->dest
= DISPLAY_LCDC
;
159 * alloc panel device data
161 if (platform_device_add_data
162 (mdp_dev
, pdev
->dev
.platform_data
,
163 sizeof(struct msm_fb_panel_data
))) {
164 printk(KERN_ERR
"lcdc_probe: platform_device_add_data failed!\n");
165 platform_device_put(mdp_dev
);
171 pdata
= (struct msm_fb_panel_data
*)mdp_dev
->dev
.platform_data
;
173 pdata
->off
= lcdc_off
;
177 * get/set panel specific fb info
179 mfd
->panel_info
= pdata
->panel_info
;
180 mfd
->fb_imgType
= MDP_RGB_565
;
183 fbi
->var
.pixclock
= mfd
->panel_info
.clk_rate
;
184 fbi
->var
.left_margin
= mfd
->panel_info
.lcdc
.h_back_porch
;
185 fbi
->var
.right_margin
= mfd
->panel_info
.lcdc
.h_front_porch
;
186 fbi
->var
.upper_margin
= mfd
->panel_info
.lcdc
.v_back_porch
;
187 fbi
->var
.lower_margin
= mfd
->panel_info
.lcdc
.v_front_porch
;
188 fbi
->var
.hsync_len
= mfd
->panel_info
.lcdc
.h_pulse_width
;
189 fbi
->var
.vsync_len
= mfd
->panel_info
.lcdc
.v_pulse_width
;
194 platform_set_drvdata(mdp_dev
, mfd
);
197 * register in mdp driver
199 rc
= platform_device_add(mdp_dev
);
203 pdev_list
[pdev_list_cnt
++] = pdev
;
207 platform_device_put(mdp_dev
);
211 static int lcdc_remove(struct platform_device
*pdev
)
213 // pm_qos_remove_requirement(PM_QOS_SYSTEM_BUS_FREQ , "lcdc");
217 static int lcdc_register_driver(void)
219 return platform_driver_register(&lcdc_driver
);
222 static int __init
lcdc_driver_init(void)
224 mdp_lcdc_pclk_clk
= clk_get(NULL
, "mdp_lcdc_pclk_clk");
225 if (IS_ERR(mdp_lcdc_pclk_clk
)) {
226 printk(KERN_ERR
"error: can't get mdp_lcdc_pclk_clk!\n");
227 return IS_ERR(mdp_lcdc_pclk_clk
);
229 mdp_lcdc_pad_pclk_clk
= clk_get(NULL
, "mdp_lcdc_pad_pclk_clk");
230 if (IS_ERR(mdp_lcdc_pad_pclk_clk
)) {
231 printk(KERN_ERR
"error: can't get mdp_lcdc_pad_pclk_clk!\n");
232 return IS_ERR(mdp_lcdc_pad_pclk_clk
);
234 // pm_qos_add_requirement(PM_QOS_SYSTEM_BUS_FREQ , "lcdc",
235 // PM_QOS_DEFAULT_VALUE);
236 return lcdc_register_driver();
239 module_init(lcdc_driver_init
);