Commit | Line | Data |
---|---|---|
553c48cf TV |
1 | /* |
2 | * linux/drivers/video/omap2/dss/dpi.c | |
3 | * | |
4 | * Copyright (C) 2009 Nokia Corporation | |
5 | * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com> | |
6 | * | |
7 | * Some code and ideas taken from drivers/video/omap/ driver | |
8 | * by Imre Deak. | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify it | |
11 | * under the terms of the GNU General Public License version 2 as published by | |
12 | * the Free Software Foundation. | |
13 | * | |
14 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
15 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
16 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
17 | * more details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License along with | |
20 | * this program. If not, see <http://www.gnu.org/licenses/>. | |
21 | */ | |
22 | ||
23 | #define DSS_SUBSYS_NAME "DPI" | |
24 | ||
25 | #include <linux/kernel.h> | |
553c48cf | 26 | #include <linux/delay.h> |
a8a35931 | 27 | #include <linux/export.h> |
8a2cfea8 | 28 | #include <linux/err.h> |
553c48cf | 29 | #include <linux/errno.h> |
8a2cfea8 TV |
30 | #include <linux/platform_device.h> |
31 | #include <linux/regulator/consumer.h> | |
553c48cf | 32 | |
a0b38cc4 | 33 | #include <video/omapdss.h> |
553c48cf TV |
34 | |
35 | #include "dss.h" | |
195e672a | 36 | #include "dss_features.h" |
553c48cf TV |
37 | |
38 | static struct { | |
8a2cfea8 | 39 | struct regulator *vdds_dsi_reg; |
a72b64b9 | 40 | struct platform_device *dsidev; |
5cf9a264 | 41 | |
c8a5e4e8 AT |
42 | struct mutex lock; |
43 | ||
c499144c | 44 | struct omap_video_timings timings; |
5cf9a264 | 45 | struct dss_lcd_mgr_config mgr_config; |
c6b393d4 | 46 | int data_lines; |
81b87f51 AT |
47 | |
48 | struct omap_dss_output output; | |
553c48cf TV |
49 | } dpi; |
50 | ||
a72b64b9 AT |
51 | static struct platform_device *dpi_get_dsidev(enum omap_dss_clk_source clk) |
52 | { | |
53 | int dsi_module; | |
54 | ||
55 | dsi_module = clk == OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC ? 0 : 1; | |
56 | ||
57 | return dsi_get_dsidev_from_id(dsi_module); | |
58 | } | |
59 | ||
7636b3b4 AT |
60 | static bool dpi_use_dsi_pll(struct omap_dss_device *dssdev) |
61 | { | |
62 | if (dssdev->clocks.dispc.dispc_fclk_src == | |
63 | OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC || | |
5a8b572d AT |
64 | dssdev->clocks.dispc.dispc_fclk_src == |
65 | OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC || | |
7636b3b4 | 66 | dssdev->clocks.dispc.channel.lcd_clk_src == |
5a8b572d AT |
67 | OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC || |
68 | dssdev->clocks.dispc.channel.lcd_clk_src == | |
69 | OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC) | |
7636b3b4 AT |
70 | return true; |
71 | else | |
72 | return false; | |
73 | } | |
74 | ||
6d523e7b | 75 | static int dpi_set_dsi_clk(struct omap_dss_device *dssdev, |
ff1b2cde SS |
76 | unsigned long pck_req, unsigned long *fck, int *lck_div, |
77 | int *pck_div) | |
553c48cf TV |
78 | { |
79 | struct dsi_clock_info dsi_cinfo; | |
80 | struct dispc_clock_info dispc_cinfo; | |
81 | int r; | |
82 | ||
6d523e7b AT |
83 | r = dsi_pll_calc_clock_div_pck(dpi.dsidev, pck_req, &dsi_cinfo, |
84 | &dispc_cinfo); | |
553c48cf TV |
85 | if (r) |
86 | return r; | |
87 | ||
a72b64b9 | 88 | r = dsi_pll_set_clock_div(dpi.dsidev, &dsi_cinfo); |
553c48cf TV |
89 | if (r) |
90 | return r; | |
91 | ||
e8881662 | 92 | dss_select_dispc_clk_source(dssdev->clocks.dispc.dispc_fclk_src); |
553c48cf | 93 | |
5cf9a264 | 94 | dpi.mgr_config.clock_info = dispc_cinfo; |
553c48cf | 95 | |
1bb47835 | 96 | *fck = dsi_cinfo.dsi_pll_hsdiv_dispc_clk; |
553c48cf TV |
97 | *lck_div = dispc_cinfo.lck_div; |
98 | *pck_div = dispc_cinfo.pck_div; | |
99 | ||
100 | return 0; | |
101 | } | |
7636b3b4 | 102 | |
6d523e7b | 103 | static int dpi_set_dispc_clk(struct omap_dss_device *dssdev, |
ff1b2cde SS |
104 | unsigned long pck_req, unsigned long *fck, int *lck_div, |
105 | int *pck_div) | |
553c48cf TV |
106 | { |
107 | struct dss_clock_info dss_cinfo; | |
108 | struct dispc_clock_info dispc_cinfo; | |
109 | int r; | |
110 | ||
6d523e7b | 111 | r = dss_calc_clock_div(pck_req, &dss_cinfo, &dispc_cinfo); |
553c48cf TV |
112 | if (r) |
113 | return r; | |
114 | ||
115 | r = dss_set_clock_div(&dss_cinfo); | |
116 | if (r) | |
117 | return r; | |
118 | ||
5cf9a264 | 119 | dpi.mgr_config.clock_info = dispc_cinfo; |
553c48cf TV |
120 | |
121 | *fck = dss_cinfo.fck; | |
122 | *lck_div = dispc_cinfo.lck_div; | |
123 | *pck_div = dispc_cinfo.pck_div; | |
124 | ||
125 | return 0; | |
126 | } | |
553c48cf TV |
127 | |
128 | static int dpi_set_mode(struct omap_dss_device *dssdev) | |
129 | { | |
c499144c | 130 | struct omap_video_timings *t = &dpi.timings; |
7636b3b4 AT |
131 | int lck_div = 0, pck_div = 0; |
132 | unsigned long fck = 0; | |
553c48cf | 133 | unsigned long pck; |
553c48cf TV |
134 | int r = 0; |
135 | ||
7636b3b4 | 136 | if (dpi_use_dsi_pll(dssdev)) |
6d523e7b AT |
137 | r = dpi_set_dsi_clk(dssdev, t->pixel_clock * 1000, &fck, |
138 | &lck_div, &pck_div); | |
7636b3b4 | 139 | else |
6d523e7b AT |
140 | r = dpi_set_dispc_clk(dssdev, t->pixel_clock * 1000, &fck, |
141 | &lck_div, &pck_div); | |
553c48cf | 142 | if (r) |
4fbafaf3 | 143 | return r; |
553c48cf TV |
144 | |
145 | pck = fck / lck_div / pck_div / 1000; | |
146 | ||
147 | if (pck != t->pixel_clock) { | |
148 | DSSWARN("Could not find exact pixel clock. " | |
149 | "Requested %d kHz, got %lu kHz\n", | |
150 | t->pixel_clock, pck); | |
151 | ||
152 | t->pixel_clock = pck; | |
153 | } | |
154 | ||
41721163 | 155 | dss_mgr_set_timings(dssdev->manager, t); |
553c48cf | 156 | |
4fbafaf3 | 157 | return 0; |
553c48cf TV |
158 | } |
159 | ||
5cf9a264 | 160 | static void dpi_config_lcd_manager(struct omap_dss_device *dssdev) |
553c48cf | 161 | { |
5cf9a264 | 162 | dpi.mgr_config.io_pad_mode = DSS_IO_PAD_MODE_BYPASS; |
569969d6 | 163 | |
5cf9a264 AT |
164 | dpi.mgr_config.stallmode = false; |
165 | dpi.mgr_config.fifohandcheck = false; | |
166 | ||
c6b393d4 | 167 | dpi.mgr_config.video_port_width = dpi.data_lines; |
5cf9a264 AT |
168 | |
169 | dpi.mgr_config.lcden_sig_polarity = 0; | |
170 | ||
f476ae9d | 171 | dss_mgr_set_lcd_config(dssdev->manager, &dpi.mgr_config); |
553c48cf TV |
172 | } |
173 | ||
37ac60e4 | 174 | int omapdss_dpi_display_enable(struct omap_dss_device *dssdev) |
553c48cf TV |
175 | { |
176 | int r; | |
177 | ||
c8a5e4e8 AT |
178 | mutex_lock(&dpi.lock); |
179 | ||
195e672a | 180 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI) && !dpi.vdds_dsi_reg) { |
40410715 | 181 | DSSERR("no VDSS_DSI regulator\n"); |
c8a5e4e8 AT |
182 | r = -ENODEV; |
183 | goto err_no_reg; | |
40410715 RK |
184 | } |
185 | ||
05e1d606 TV |
186 | if (dssdev->manager == NULL) { |
187 | DSSERR("failed to enable display: no manager\n"); | |
c8a5e4e8 AT |
188 | r = -ENODEV; |
189 | goto err_no_mgr; | |
05e1d606 TV |
190 | } |
191 | ||
553c48cf TV |
192 | r = omap_dss_start_device(dssdev); |
193 | if (r) { | |
194 | DSSERR("failed to start device\n"); | |
4fbafaf3 | 195 | goto err_start_dev; |
553c48cf TV |
196 | } |
197 | ||
195e672a | 198 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) { |
8a2cfea8 TV |
199 | r = regulator_enable(dpi.vdds_dsi_reg); |
200 | if (r) | |
4fbafaf3 | 201 | goto err_reg_enable; |
8a2cfea8 TV |
202 | } |
203 | ||
4fbafaf3 | 204 | r = dispc_runtime_get(); |
553c48cf | 205 | if (r) |
4fbafaf3 TV |
206 | goto err_get_dispc; |
207 | ||
de09e455 TV |
208 | r = dss_dpi_select_source(dssdev->channel); |
209 | if (r) | |
210 | goto err_src_sel; | |
211 | ||
7636b3b4 | 212 | if (dpi_use_dsi_pll(dssdev)) { |
4fbafaf3 TV |
213 | r = dsi_runtime_get(dpi.dsidev); |
214 | if (r) | |
215 | goto err_get_dsi; | |
216 | ||
a72b64b9 | 217 | r = dsi_pll_init(dpi.dsidev, 0, 1); |
7636b3b4 | 218 | if (r) |
4fbafaf3 | 219 | goto err_dsi_pll_init; |
7636b3b4 AT |
220 | } |
221 | ||
553c48cf TV |
222 | r = dpi_set_mode(dssdev); |
223 | if (r) | |
4fbafaf3 | 224 | goto err_set_mode; |
553c48cf | 225 | |
5cf9a264 AT |
226 | dpi_config_lcd_manager(dssdev); |
227 | ||
553c48cf TV |
228 | mdelay(2); |
229 | ||
33ca237f TV |
230 | r = dss_mgr_enable(dssdev->manager); |
231 | if (r) | |
232 | goto err_mgr_enable; | |
553c48cf | 233 | |
c8a5e4e8 AT |
234 | mutex_unlock(&dpi.lock); |
235 | ||
553c48cf TV |
236 | return 0; |
237 | ||
33ca237f | 238 | err_mgr_enable: |
4fbafaf3 | 239 | err_set_mode: |
7636b3b4 | 240 | if (dpi_use_dsi_pll(dssdev)) |
19077a73 | 241 | dsi_pll_uninit(dpi.dsidev, true); |
4fbafaf3 TV |
242 | err_dsi_pll_init: |
243 | if (dpi_use_dsi_pll(dssdev)) | |
244 | dsi_runtime_put(dpi.dsidev); | |
245 | err_get_dsi: | |
de09e455 | 246 | err_src_sel: |
4fbafaf3 TV |
247 | dispc_runtime_put(); |
248 | err_get_dispc: | |
195e672a | 249 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) |
8a2cfea8 | 250 | regulator_disable(dpi.vdds_dsi_reg); |
4fbafaf3 | 251 | err_reg_enable: |
553c48cf | 252 | omap_dss_stop_device(dssdev); |
4fbafaf3 | 253 | err_start_dev: |
c8a5e4e8 AT |
254 | err_no_mgr: |
255 | err_no_reg: | |
256 | mutex_unlock(&dpi.lock); | |
553c48cf TV |
257 | return r; |
258 | } | |
37ac60e4 | 259 | EXPORT_SYMBOL(omapdss_dpi_display_enable); |
553c48cf | 260 | |
37ac60e4 | 261 | void omapdss_dpi_display_disable(struct omap_dss_device *dssdev) |
553c48cf | 262 | { |
c8a5e4e8 AT |
263 | mutex_lock(&dpi.lock); |
264 | ||
7797c6da | 265 | dss_mgr_disable(dssdev->manager); |
553c48cf | 266 | |
7636b3b4 AT |
267 | if (dpi_use_dsi_pll(dssdev)) { |
268 | dss_select_dispc_clk_source(OMAP_DSS_CLK_SRC_FCK); | |
a72b64b9 | 269 | dsi_pll_uninit(dpi.dsidev, true); |
4fbafaf3 | 270 | dsi_runtime_put(dpi.dsidev); |
7636b3b4 | 271 | } |
553c48cf | 272 | |
4fbafaf3 | 273 | dispc_runtime_put(); |
553c48cf | 274 | |
195e672a | 275 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) |
8a2cfea8 TV |
276 | regulator_disable(dpi.vdds_dsi_reg); |
277 | ||
553c48cf | 278 | omap_dss_stop_device(dssdev); |
c8a5e4e8 AT |
279 | |
280 | mutex_unlock(&dpi.lock); | |
553c48cf | 281 | } |
37ac60e4 | 282 | EXPORT_SYMBOL(omapdss_dpi_display_disable); |
553c48cf | 283 | |
c499144c AT |
284 | void omapdss_dpi_set_timings(struct omap_dss_device *dssdev, |
285 | struct omap_video_timings *timings) | |
553c48cf TV |
286 | { |
287 | DSSDBG("dpi_set_timings\n"); | |
c8a5e4e8 AT |
288 | |
289 | mutex_lock(&dpi.lock); | |
290 | ||
c499144c | 291 | dpi.timings = *timings; |
c499144c | 292 | |
c8a5e4e8 | 293 | mutex_unlock(&dpi.lock); |
553c48cf | 294 | } |
c499144c | 295 | EXPORT_SYMBOL(omapdss_dpi_set_timings); |
553c48cf | 296 | |
69b2048f | 297 | int dpi_check_timings(struct omap_dss_device *dssdev, |
553c48cf TV |
298 | struct omap_video_timings *timings) |
299 | { | |
553c48cf TV |
300 | int r; |
301 | int lck_div, pck_div; | |
302 | unsigned long fck; | |
303 | unsigned long pck; | |
7636b3b4 | 304 | struct dispc_clock_info dispc_cinfo; |
553c48cf | 305 | |
b917fa39 | 306 | if (dss_mgr_check_timings(dssdev->manager, timings)) |
553c48cf TV |
307 | return -EINVAL; |
308 | ||
309 | if (timings->pixel_clock == 0) | |
310 | return -EINVAL; | |
311 | ||
7636b3b4 | 312 | if (dpi_use_dsi_pll(dssdev)) { |
553c48cf | 313 | struct dsi_clock_info dsi_cinfo; |
6d523e7b | 314 | r = dsi_pll_calc_clock_div_pck(dpi.dsidev, |
553c48cf TV |
315 | timings->pixel_clock * 1000, |
316 | &dsi_cinfo, &dispc_cinfo); | |
317 | ||
318 | if (r) | |
319 | return r; | |
320 | ||
1bb47835 | 321 | fck = dsi_cinfo.dsi_pll_hsdiv_dispc_clk; |
7636b3b4 | 322 | } else { |
553c48cf | 323 | struct dss_clock_info dss_cinfo; |
6d523e7b | 324 | r = dss_calc_clock_div(timings->pixel_clock * 1000, |
553c48cf TV |
325 | &dss_cinfo, &dispc_cinfo); |
326 | ||
327 | if (r) | |
328 | return r; | |
329 | ||
330 | fck = dss_cinfo.fck; | |
553c48cf | 331 | } |
7636b3b4 AT |
332 | |
333 | lck_div = dispc_cinfo.lck_div; | |
334 | pck_div = dispc_cinfo.pck_div; | |
553c48cf TV |
335 | |
336 | pck = fck / lck_div / pck_div / 1000; | |
337 | ||
338 | timings->pixel_clock = pck; | |
339 | ||
340 | return 0; | |
341 | } | |
69b2048f | 342 | EXPORT_SYMBOL(dpi_check_timings); |
553c48cf | 343 | |
c6b393d4 AT |
344 | void omapdss_dpi_set_data_lines(struct omap_dss_device *dssdev, int data_lines) |
345 | { | |
346 | mutex_lock(&dpi.lock); | |
347 | ||
348 | dpi.data_lines = data_lines; | |
349 | ||
350 | mutex_unlock(&dpi.lock); | |
351 | } | |
352 | EXPORT_SYMBOL(omapdss_dpi_set_data_lines); | |
353 | ||
9d8232a7 | 354 | static int __init dpi_init_display(struct omap_dss_device *dssdev) |
553c48cf TV |
355 | { |
356 | DSSDBG("init_display\n"); | |
357 | ||
195e672a CM |
358 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI) && |
359 | dpi.vdds_dsi_reg == NULL) { | |
5f42f2ce | 360 | struct regulator *vdds_dsi; |
553c48cf | 361 | |
5f42f2ce TV |
362 | vdds_dsi = dss_get_vdds_dsi(); |
363 | ||
364 | if (IS_ERR(vdds_dsi)) { | |
8a2cfea8 | 365 | DSSERR("can't get VDDS_DSI regulator\n"); |
5f42f2ce | 366 | return PTR_ERR(vdds_dsi); |
8a2cfea8 | 367 | } |
5f42f2ce TV |
368 | |
369 | dpi.vdds_dsi_reg = vdds_dsi; | |
8a2cfea8 TV |
370 | } |
371 | ||
a72b64b9 AT |
372 | if (dpi_use_dsi_pll(dssdev)) { |
373 | enum omap_dss_clk_source dispc_fclk_src = | |
374 | dssdev->clocks.dispc.dispc_fclk_src; | |
375 | dpi.dsidev = dpi_get_dsidev(dispc_fclk_src); | |
376 | } | |
377 | ||
553c48cf TV |
378 | return 0; |
379 | } | |
380 | ||
1521653c | 381 | static struct omap_dss_device * __init dpi_find_dssdev(struct platform_device *pdev) |
5f42f2ce | 382 | { |
35deca3d | 383 | struct omap_dss_board_info *pdata = pdev->dev.platform_data; |
1521653c TV |
384 | const char *def_disp_name = dss_get_default_display_name(); |
385 | struct omap_dss_device *def_dssdev; | |
386 | int i; | |
387 | ||
388 | def_dssdev = NULL; | |
35deca3d TV |
389 | |
390 | for (i = 0; i < pdata->num_devices; ++i) { | |
391 | struct omap_dss_device *dssdev = pdata->devices[i]; | |
392 | ||
393 | if (dssdev->type != OMAP_DISPLAY_TYPE_DPI) | |
394 | continue; | |
395 | ||
1521653c TV |
396 | if (def_dssdev == NULL) |
397 | def_dssdev = dssdev; | |
398 | ||
399 | if (def_disp_name != NULL && | |
400 | strcmp(dssdev->name, def_disp_name) == 0) { | |
401 | def_dssdev = dssdev; | |
402 | break; | |
9d8232a7 | 403 | } |
1521653c | 404 | } |
9d8232a7 | 405 | |
1521653c TV |
406 | return def_dssdev; |
407 | } | |
408 | ||
5274484b | 409 | static void __init dpi_probe_pdata(struct platform_device *dpidev) |
1521653c | 410 | { |
5274484b | 411 | struct omap_dss_device *plat_dssdev; |
1521653c TV |
412 | struct omap_dss_device *dssdev; |
413 | int r; | |
414 | ||
5274484b | 415 | plat_dssdev = dpi_find_dssdev(dpidev); |
1521653c | 416 | |
5274484b TV |
417 | if (!plat_dssdev) |
418 | return; | |
419 | ||
420 | dssdev = dss_alloc_and_init_device(&dpidev->dev); | |
1521653c TV |
421 | if (!dssdev) |
422 | return; | |
423 | ||
5274484b TV |
424 | dss_copy_device_pdata(dssdev, plat_dssdev); |
425 | ||
1521653c TV |
426 | r = dpi_init_display(dssdev); |
427 | if (r) { | |
428 | DSSERR("device %s init failed: %d\n", dssdev->name, r); | |
5274484b | 429 | dss_put_device(dssdev); |
1521653c TV |
430 | return; |
431 | } | |
432 | ||
5274484b | 433 | r = dss_add_device(dssdev); |
1521653c TV |
434 | if (r) { |
435 | DSSERR("device %s register failed: %d\n", dssdev->name, r); | |
5274484b | 436 | dss_put_device(dssdev); |
1521653c | 437 | return; |
35deca3d | 438 | } |
38f3daf6 TV |
439 | } |
440 | ||
81b87f51 AT |
441 | static void __init dpi_init_output(struct platform_device *pdev) |
442 | { | |
443 | struct omap_dss_output *out = &dpi.output; | |
444 | ||
445 | out->pdev = pdev; | |
446 | out->id = OMAP_DSS_OUTPUT_DPI; | |
447 | out->type = OMAP_DISPLAY_TYPE_DPI; | |
448 | ||
449 | dss_register_output(out); | |
450 | } | |
451 | ||
452 | static void __exit dpi_uninit_output(struct platform_device *pdev) | |
453 | { | |
454 | struct omap_dss_output *out = &dpi.output; | |
455 | ||
456 | dss_unregister_output(out); | |
457 | } | |
458 | ||
38f3daf6 TV |
459 | static int __init omap_dpi_probe(struct platform_device *pdev) |
460 | { | |
c8a5e4e8 AT |
461 | mutex_init(&dpi.lock); |
462 | ||
81b87f51 AT |
463 | dpi_init_output(pdev); |
464 | ||
38f3daf6 | 465 | dpi_probe_pdata(pdev); |
35deca3d | 466 | |
5f42f2ce TV |
467 | return 0; |
468 | } | |
469 | ||
6e7e8f06 | 470 | static int __exit omap_dpi_remove(struct platform_device *pdev) |
553c48cf | 471 | { |
5274484b | 472 | dss_unregister_child_devices(&pdev->dev); |
35deca3d | 473 | |
81b87f51 AT |
474 | dpi_uninit_output(pdev); |
475 | ||
a57dd4fe | 476 | return 0; |
553c48cf TV |
477 | } |
478 | ||
a57dd4fe | 479 | static struct platform_driver omap_dpi_driver = { |
6e7e8f06 | 480 | .remove = __exit_p(omap_dpi_remove), |
a57dd4fe TV |
481 | .driver = { |
482 | .name = "omapdss_dpi", | |
483 | .owner = THIS_MODULE, | |
484 | }, | |
485 | }; | |
486 | ||
6e7e8f06 | 487 | int __init dpi_init_platform_driver(void) |
a57dd4fe | 488 | { |
61055d4b | 489 | return platform_driver_probe(&omap_dpi_driver, omap_dpi_probe); |
a57dd4fe TV |
490 | } |
491 | ||
6e7e8f06 | 492 | void __exit dpi_uninit_platform_driver(void) |
a57dd4fe TV |
493 | { |
494 | platform_driver_unregister(&omap_dpi_driver); | |
495 | } |