Commit | Line | Data |
---|---|---|
23c0a7a6 TV |
1 | /* |
2 | * linux/drivers/video/omap2/dss/sdi.c | |
3 | * | |
4 | * Copyright (C) 2009 Nokia Corporation | |
5 | * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify it | |
8 | * under the terms of the GNU General Public License version 2 as published by | |
9 | * the Free Software Foundation. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
12 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
13 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
14 | * more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License along with | |
17 | * this program. If not, see <http://www.gnu.org/licenses/>. | |
18 | */ | |
19 | ||
20 | #define DSS_SUBSYS_NAME "SDI" | |
21 | ||
22 | #include <linux/kernel.h> | |
23 | #include <linux/clk.h> | |
24 | #include <linux/delay.h> | |
25 | #include <linux/err.h> | |
26 | ||
27 | #include <plat/display.h> | |
28 | #include "dss.h" | |
29 | ||
30 | static struct { | |
31 | bool skip_init; | |
32 | bool update_enabled; | |
33 | } sdi; | |
34 | ||
35 | static void sdi_basic_init(void) | |
36 | { | |
37 | dispc_set_parallel_interface_mode(OMAP_DSS_PARALLELMODE_BYPASS); | |
38 | ||
39 | dispc_set_lcd_display_type(OMAP_DSS_LCD_DISPLAY_TFT); | |
40 | dispc_set_tft_data_lines(24); | |
41 | dispc_lcd_enable_signal_polarity(1); | |
42 | } | |
43 | ||
44 | static int sdi_display_enable(struct omap_dss_device *dssdev) | |
45 | { | |
46 | struct omap_video_timings *t = &dssdev->panel.timings; | |
47 | struct dss_clock_info dss_cinfo; | |
48 | struct dispc_clock_info dispc_cinfo; | |
49 | u16 lck_div, pck_div; | |
50 | unsigned long fck; | |
51 | unsigned long pck; | |
52 | int r; | |
53 | ||
54 | r = omap_dss_start_device(dssdev); | |
55 | if (r) { | |
56 | DSSERR("failed to start device\n"); | |
57 | goto err0; | |
58 | } | |
59 | ||
60 | if (dssdev->state != OMAP_DSS_DISPLAY_DISABLED) { | |
61 | DSSERR("dssdev already enabled\n"); | |
62 | r = -EINVAL; | |
63 | goto err1; | |
64 | } | |
65 | ||
66 | /* In case of skip_init sdi_init has already enabled the clocks */ | |
67 | if (!sdi.skip_init) | |
68 | dss_clk_enable(DSS_CLK_ICK | DSS_CLK_FCK1); | |
69 | ||
70 | sdi_basic_init(); | |
71 | ||
72 | /* 15.5.9.1.2 */ | |
73 | dssdev->panel.config |= OMAP_DSS_LCD_RF | OMAP_DSS_LCD_ONOFF; | |
74 | ||
75 | dispc_set_pol_freq(dssdev->panel.config, dssdev->panel.acbi, | |
76 | dssdev->panel.acb); | |
77 | ||
78 | if (!sdi.skip_init) { | |
79 | r = dss_calc_clock_div(1, t->pixel_clock * 1000, | |
80 | &dss_cinfo, &dispc_cinfo); | |
81 | } else { | |
82 | r = dss_get_clock_div(&dss_cinfo); | |
83 | r = dispc_get_clock_div(&dispc_cinfo); | |
84 | } | |
85 | ||
86 | if (r) | |
87 | goto err2; | |
88 | ||
89 | fck = dss_cinfo.fck; | |
90 | lck_div = dispc_cinfo.lck_div; | |
91 | pck_div = dispc_cinfo.pck_div; | |
92 | ||
93 | pck = fck / lck_div / pck_div / 1000; | |
94 | ||
95 | if (pck != t->pixel_clock) { | |
96 | DSSWARN("Could not find exact pixel clock. Requested %d kHz, " | |
97 | "got %lu kHz\n", | |
98 | t->pixel_clock, pck); | |
99 | ||
100 | t->pixel_clock = pck; | |
101 | } | |
102 | ||
103 | ||
104 | dispc_set_lcd_timings(t); | |
105 | ||
106 | r = dss_set_clock_div(&dss_cinfo); | |
107 | if (r) | |
108 | goto err2; | |
109 | ||
110 | r = dispc_set_clock_div(&dispc_cinfo); | |
111 | if (r) | |
112 | goto err2; | |
113 | ||
114 | if (!sdi.skip_init) { | |
115 | dss_sdi_init(dssdev->phy.sdi.datapairs); | |
116 | r = dss_sdi_enable(); | |
117 | if (r) | |
118 | goto err1; | |
119 | mdelay(2); | |
120 | } | |
121 | ||
a2faee84 | 122 | dssdev->manager->enable(dssdev->manager); |
23c0a7a6 TV |
123 | |
124 | if (dssdev->driver->enable) { | |
125 | r = dssdev->driver->enable(dssdev); | |
126 | if (r) | |
127 | goto err3; | |
128 | } | |
129 | ||
130 | dssdev->state = OMAP_DSS_DISPLAY_ACTIVE; | |
131 | ||
132 | sdi.skip_init = 0; | |
133 | ||
134 | return 0; | |
135 | err3: | |
a2faee84 | 136 | dssdev->manager->disable(dssdev->manager); |
23c0a7a6 TV |
137 | err2: |
138 | dss_clk_disable(DSS_CLK_ICK | DSS_CLK_FCK1); | |
139 | err1: | |
140 | omap_dss_stop_device(dssdev); | |
141 | err0: | |
142 | return r; | |
143 | } | |
144 | ||
145 | static int sdi_display_resume(struct omap_dss_device *dssdev); | |
146 | ||
147 | static void sdi_display_disable(struct omap_dss_device *dssdev) | |
148 | { | |
149 | if (dssdev->state == OMAP_DSS_DISPLAY_DISABLED) | |
150 | return; | |
151 | ||
152 | if (dssdev->state == OMAP_DSS_DISPLAY_SUSPENDED) | |
153 | if (sdi_display_resume(dssdev)) | |
154 | return; | |
155 | ||
156 | if (dssdev->driver->disable) | |
157 | dssdev->driver->disable(dssdev); | |
158 | ||
a2faee84 | 159 | dssdev->manager->disable(dssdev->manager); |
23c0a7a6 TV |
160 | |
161 | dss_sdi_disable(); | |
162 | ||
163 | dss_clk_disable(DSS_CLK_ICK | DSS_CLK_FCK1); | |
164 | ||
165 | dssdev->state = OMAP_DSS_DISPLAY_DISABLED; | |
166 | ||
167 | omap_dss_stop_device(dssdev); | |
168 | } | |
169 | ||
170 | static int sdi_display_suspend(struct omap_dss_device *dssdev) | |
171 | { | |
172 | if (dssdev->state != OMAP_DSS_DISPLAY_ACTIVE) | |
173 | return -EINVAL; | |
174 | ||
175 | if (dssdev->driver->suspend) | |
176 | dssdev->driver->suspend(dssdev); | |
177 | ||
a2faee84 | 178 | dssdev->manager->disable(dssdev->manager); |
23c0a7a6 TV |
179 | |
180 | dss_sdi_disable(); | |
181 | ||
182 | dss_clk_disable(DSS_CLK_ICK | DSS_CLK_FCK1); | |
183 | ||
184 | dssdev->state = OMAP_DSS_DISPLAY_SUSPENDED; | |
185 | ||
186 | return 0; | |
187 | } | |
188 | ||
189 | static int sdi_display_resume(struct omap_dss_device *dssdev) | |
190 | { | |
191 | int r; | |
192 | ||
193 | if (dssdev->state != OMAP_DSS_DISPLAY_SUSPENDED) | |
194 | return -EINVAL; | |
195 | ||
196 | dss_clk_enable(DSS_CLK_ICK | DSS_CLK_FCK1); | |
197 | ||
198 | r = dss_sdi_enable(); | |
199 | if (r) | |
200 | goto err; | |
201 | mdelay(2); | |
202 | ||
a2faee84 | 203 | dssdev->manager->enable(dssdev->manager); |
23c0a7a6 TV |
204 | |
205 | if (dssdev->driver->resume) | |
206 | dssdev->driver->resume(dssdev); | |
207 | ||
208 | dssdev->state = OMAP_DSS_DISPLAY_ACTIVE; | |
209 | ||
210 | return 0; | |
211 | err: | |
212 | dss_clk_disable(DSS_CLK_ICK | DSS_CLK_FCK1); | |
213 | return r; | |
214 | } | |
215 | ||
23c0a7a6 TV |
216 | static void sdi_get_timings(struct omap_dss_device *dssdev, |
217 | struct omap_video_timings *timings) | |
218 | { | |
219 | *timings = dssdev->panel.timings; | |
220 | } | |
221 | ||
222 | int sdi_init_display(struct omap_dss_device *dssdev) | |
223 | { | |
224 | DSSDBG("SDI init\n"); | |
225 | ||
226 | dssdev->enable = sdi_display_enable; | |
227 | dssdev->disable = sdi_display_disable; | |
228 | dssdev->suspend = sdi_display_suspend; | |
229 | dssdev->resume = sdi_display_resume; | |
23c0a7a6 TV |
230 | dssdev->get_timings = sdi_get_timings; |
231 | ||
232 | return 0; | |
233 | } | |
234 | ||
235 | int sdi_init(bool skip_init) | |
236 | { | |
237 | /* we store this for first display enable, then clear it */ | |
238 | sdi.skip_init = skip_init; | |
239 | ||
240 | /* | |
241 | * Enable clocks already here, otherwise there would be a toggle | |
242 | * of them until sdi_display_enable is called. | |
243 | */ | |
244 | if (skip_init) | |
245 | dss_clk_enable(DSS_CLK_ICK | DSS_CLK_FCK1); | |
246 | return 0; | |
247 | } | |
248 | ||
249 | void sdi_exit(void) | |
250 | { | |
251 | } |