blob: 15c2c3301f48eb15297a3c1fff40a315a72b08da [file] [log] [blame]
Tomi Valkeinen553c48c2009-08-07 13:15:50 +03001/*
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>
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030026#include <linux/delay.h>
Paul Gortmakera8a35932011-07-10 13:20:26 -040027#include <linux/export.h>
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +020028#include <linux/err.h>
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030029#include <linux/errno.h>
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +020030#include <linux/platform_device.h>
31#include <linux/regulator/consumer.h>
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030032
Tomi Valkeinena0b38cc2011-05-11 14:05:07 +030033#include <video/omapdss.h>
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030034#include <plat/cpu.h>
35
36#include "dss.h"
37
38static struct {
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +020039 struct regulator *vdds_dsi_reg;
Archit Tanejaa72b64b2011-05-12 17:26:26 +053040 struct platform_device *dsidev;
Archit Taneja5cf9a262012-06-29 14:19:13 +053041
Archit Tanejac8a5e4e2012-07-05 12:52:46 +053042 struct mutex lock;
43
Archit Taneja5cf9a262012-06-29 14:19:13 +053044 struct dss_lcd_mgr_config mgr_config;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030045} dpi;
46
Archit Tanejaa72b64b2011-05-12 17:26:26 +053047static struct platform_device *dpi_get_dsidev(enum omap_dss_clk_source clk)
48{
49 int dsi_module;
50
51 dsi_module = clk == OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC ? 0 : 1;
52
53 return dsi_get_dsidev_from_id(dsi_module);
54}
55
Archit Taneja7636b3b2011-04-12 13:52:26 +053056static bool dpi_use_dsi_pll(struct omap_dss_device *dssdev)
57{
58 if (dssdev->clocks.dispc.dispc_fclk_src ==
59 OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC ||
Archit Taneja5a8b5722011-05-12 17:26:29 +053060 dssdev->clocks.dispc.dispc_fclk_src ==
61 OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC ||
Archit Taneja7636b3b2011-04-12 13:52:26 +053062 dssdev->clocks.dispc.channel.lcd_clk_src ==
Archit Taneja5a8b5722011-05-12 17:26:29 +053063 OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC ||
64 dssdev->clocks.dispc.channel.lcd_clk_src ==
65 OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC)
Archit Taneja7636b3b2011-04-12 13:52:26 +053066 return true;
67 else
68 return false;
69}
70
Archit Taneja6d523e72012-06-21 09:33:55 +053071static int dpi_set_dsi_clk(struct omap_dss_device *dssdev,
Sumit Semwalff1b2cd2010-12-02 11:27:11 +000072 unsigned long pck_req, unsigned long *fck, int *lck_div,
73 int *pck_div)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030074{
75 struct dsi_clock_info dsi_cinfo;
76 struct dispc_clock_info dispc_cinfo;
77 int r;
78
Archit Taneja6d523e72012-06-21 09:33:55 +053079 r = dsi_pll_calc_clock_div_pck(dpi.dsidev, pck_req, &dsi_cinfo,
80 &dispc_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030081 if (r)
82 return r;
83
Archit Tanejaa72b64b2011-05-12 17:26:26 +053084 r = dsi_pll_set_clock_div(dpi.dsidev, &dsi_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030085 if (r)
86 return r;
87
Archit Tanejae8881662011-04-12 13:52:24 +053088 dss_select_dispc_clk_source(dssdev->clocks.dispc.dispc_fclk_src);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030089
Archit Taneja5cf9a262012-06-29 14:19:13 +053090 dpi.mgr_config.clock_info = dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030091
Archit Taneja1bb47832011-02-24 14:17:30 +053092 *fck = dsi_cinfo.dsi_pll_hsdiv_dispc_clk;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030093 *lck_div = dispc_cinfo.lck_div;
94 *pck_div = dispc_cinfo.pck_div;
95
96 return 0;
97}
Archit Taneja7636b3b2011-04-12 13:52:26 +053098
Archit Taneja6d523e72012-06-21 09:33:55 +053099static int dpi_set_dispc_clk(struct omap_dss_device *dssdev,
Sumit Semwalff1b2cd2010-12-02 11:27:11 +0000100 unsigned long pck_req, unsigned long *fck, int *lck_div,
101 int *pck_div)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300102{
103 struct dss_clock_info dss_cinfo;
104 struct dispc_clock_info dispc_cinfo;
105 int r;
106
Archit Taneja6d523e72012-06-21 09:33:55 +0530107 r = dss_calc_clock_div(pck_req, &dss_cinfo, &dispc_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300108 if (r)
109 return r;
110
111 r = dss_set_clock_div(&dss_cinfo);
112 if (r)
113 return r;
114
Archit Taneja5cf9a262012-06-29 14:19:13 +0530115 dpi.mgr_config.clock_info = dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300116
117 *fck = dss_cinfo.fck;
118 *lck_div = dispc_cinfo.lck_div;
119 *pck_div = dispc_cinfo.pck_div;
120
121 return 0;
122}
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300123
124static int dpi_set_mode(struct omap_dss_device *dssdev)
125{
126 struct omap_video_timings *t = &dssdev->panel.timings;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530127 int lck_div = 0, pck_div = 0;
128 unsigned long fck = 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300129 unsigned long pck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300130 int r = 0;
131
Archit Taneja7636b3b2011-04-12 13:52:26 +0530132 if (dpi_use_dsi_pll(dssdev))
Archit Taneja6d523e72012-06-21 09:33:55 +0530133 r = dpi_set_dsi_clk(dssdev, t->pixel_clock * 1000, &fck,
134 &lck_div, &pck_div);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530135 else
Archit Taneja6d523e72012-06-21 09:33:55 +0530136 r = dpi_set_dispc_clk(dssdev, t->pixel_clock * 1000, &fck,
137 &lck_div, &pck_div);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300138 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300139 return r;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300140
141 pck = fck / lck_div / pck_div / 1000;
142
143 if (pck != t->pixel_clock) {
144 DSSWARN("Could not find exact pixel clock. "
145 "Requested %d kHz, got %lu kHz\n",
146 t->pixel_clock, pck);
147
148 t->pixel_clock = pck;
149 }
150
Archit Taneja41721162012-04-26 20:10:46 +0530151 dss_mgr_set_timings(dssdev->manager, t);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300152
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300153 return 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300154}
155
Archit Taneja5cf9a262012-06-29 14:19:13 +0530156static void dpi_config_lcd_manager(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300157{
Archit Taneja5cf9a262012-06-29 14:19:13 +0530158 dpi.mgr_config.io_pad_mode = DSS_IO_PAD_MODE_BYPASS;
Archit Taneja569969d2011-08-22 17:41:57 +0530159
Archit Taneja5cf9a262012-06-29 14:19:13 +0530160 dpi.mgr_config.stallmode = false;
161 dpi.mgr_config.fifohandcheck = false;
162
163 dpi.mgr_config.video_port_width = dssdev->phy.dpi.data_lines;
164
165 dpi.mgr_config.lcden_sig_polarity = 0;
166
Archit Tanejaf476ae92012-06-29 14:37:03 +0530167 dss_mgr_set_lcd_config(dssdev->manager, &dpi.mgr_config);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300168}
169
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200170int omapdss_dpi_display_enable(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300171{
172 int r;
173
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530174 mutex_lock(&dpi.lock);
175
Russell King40410712012-02-07 09:44:55 +0000176 if (cpu_is_omap34xx() && !dpi.vdds_dsi_reg) {
177 DSSERR("no VDSS_DSI regulator\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530178 r = -ENODEV;
179 goto err_no_reg;
Russell King40410712012-02-07 09:44:55 +0000180 }
181
Tomi Valkeinen05e1d602011-06-23 16:38:21 +0300182 if (dssdev->manager == NULL) {
183 DSSERR("failed to enable display: no manager\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530184 r = -ENODEV;
185 goto err_no_mgr;
Tomi Valkeinen05e1d602011-06-23 16:38:21 +0300186 }
187
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300188 r = omap_dss_start_device(dssdev);
189 if (r) {
190 DSSERR("failed to start device\n");
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300191 goto err_start_dev;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300192 }
193
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200194 if (cpu_is_omap34xx()) {
195 r = regulator_enable(dpi.vdds_dsi_reg);
196 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300197 goto err_reg_enable;
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200198 }
199
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300200 r = dispc_runtime_get();
201 if (r)
202 goto err_get_dispc;
203
Archit Taneja7636b3b2011-04-12 13:52:26 +0530204 if (dpi_use_dsi_pll(dssdev)) {
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300205 r = dsi_runtime_get(dpi.dsidev);
206 if (r)
207 goto err_get_dsi;
208
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530209 r = dsi_pll_init(dpi.dsidev, 0, 1);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530210 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300211 goto err_dsi_pll_init;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530212 }
213
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300214 r = dpi_set_mode(dssdev);
215 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300216 goto err_set_mode;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300217
Archit Taneja5cf9a262012-06-29 14:19:13 +0530218 dpi_config_lcd_manager(dssdev);
219
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300220 mdelay(2);
221
Tomi Valkeinen33ca2372011-11-21 13:42:58 +0200222 r = dss_mgr_enable(dssdev->manager);
223 if (r)
224 goto err_mgr_enable;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300225
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530226 mutex_unlock(&dpi.lock);
227
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300228 return 0;
229
Tomi Valkeinen33ca2372011-11-21 13:42:58 +0200230err_mgr_enable:
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300231err_set_mode:
Archit Taneja7636b3b2011-04-12 13:52:26 +0530232 if (dpi_use_dsi_pll(dssdev))
Tomi Valkeinen19077a72011-05-18 11:33:44 +0300233 dsi_pll_uninit(dpi.dsidev, true);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300234err_dsi_pll_init:
235 if (dpi_use_dsi_pll(dssdev))
236 dsi_runtime_put(dpi.dsidev);
237err_get_dsi:
238 dispc_runtime_put();
239err_get_dispc:
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200240 if (cpu_is_omap34xx())
241 regulator_disable(dpi.vdds_dsi_reg);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300242err_reg_enable:
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300243 omap_dss_stop_device(dssdev);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300244err_start_dev:
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530245err_no_mgr:
246err_no_reg:
247 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300248 return r;
249}
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200250EXPORT_SYMBOL(omapdss_dpi_display_enable);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300251
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200252void omapdss_dpi_display_disable(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300253{
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530254 mutex_lock(&dpi.lock);
255
Tomi Valkeinen7797c6d2011-11-04 10:22:46 +0200256 dss_mgr_disable(dssdev->manager);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300257
Archit Taneja7636b3b2011-04-12 13:52:26 +0530258 if (dpi_use_dsi_pll(dssdev)) {
259 dss_select_dispc_clk_source(OMAP_DSS_CLK_SRC_FCK);
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530260 dsi_pll_uninit(dpi.dsidev, true);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300261 dsi_runtime_put(dpi.dsidev);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530262 }
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300263
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300264 dispc_runtime_put();
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300265
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200266 if (cpu_is_omap34xx())
267 regulator_disable(dpi.vdds_dsi_reg);
268
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300269 omap_dss_stop_device(dssdev);
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530270
271 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300272}
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200273EXPORT_SYMBOL(omapdss_dpi_display_disable);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300274
Tomi Valkeinen69b20482010-01-20 12:11:25 +0200275void dpi_set_timings(struct omap_dss_device *dssdev,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300276 struct omap_video_timings *timings)
277{
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300278 int r;
279
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300280 DSSDBG("dpi_set_timings\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530281
282 mutex_lock(&dpi.lock);
283
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300284 dssdev->panel.timings = *timings;
285 if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE) {
Tomi Valkeinen852f0832012-02-17 17:58:04 +0200286 r = dispc_runtime_get();
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300287 if (r)
288 return;
289
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300290 dpi_set_mode(dssdev);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300291
292 dispc_runtime_put();
Archit Tanejafcc36612012-05-03 20:03:11 +0530293 } else {
294 dss_mgr_set_timings(dssdev->manager, timings);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300295 }
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530296
297 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300298}
Tomi Valkeinen69b20482010-01-20 12:11:25 +0200299EXPORT_SYMBOL(dpi_set_timings);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300300
Tomi Valkeinen69b20482010-01-20 12:11:25 +0200301int dpi_check_timings(struct omap_dss_device *dssdev,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300302 struct omap_video_timings *timings)
303{
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300304 int r;
305 int lck_div, pck_div;
306 unsigned long fck;
307 unsigned long pck;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530308 struct dispc_clock_info dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300309
Archit Tanejab917fa32012-04-27 01:07:28 +0530310 if (dss_mgr_check_timings(dssdev->manager, timings))
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300311 return -EINVAL;
312
313 if (timings->pixel_clock == 0)
314 return -EINVAL;
315
Archit Taneja7636b3b2011-04-12 13:52:26 +0530316 if (dpi_use_dsi_pll(dssdev)) {
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300317 struct dsi_clock_info dsi_cinfo;
Archit Taneja6d523e72012-06-21 09:33:55 +0530318 r = dsi_pll_calc_clock_div_pck(dpi.dsidev,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300319 timings->pixel_clock * 1000,
320 &dsi_cinfo, &dispc_cinfo);
321
322 if (r)
323 return r;
324
Archit Taneja1bb47832011-02-24 14:17:30 +0530325 fck = dsi_cinfo.dsi_pll_hsdiv_dispc_clk;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530326 } else {
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300327 struct dss_clock_info dss_cinfo;
Archit Taneja6d523e72012-06-21 09:33:55 +0530328 r = dss_calc_clock_div(timings->pixel_clock * 1000,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300329 &dss_cinfo, &dispc_cinfo);
330
331 if (r)
332 return r;
333
334 fck = dss_cinfo.fck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300335 }
Archit Taneja7636b3b2011-04-12 13:52:26 +0530336
337 lck_div = dispc_cinfo.lck_div;
338 pck_div = dispc_cinfo.pck_div;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300339
340 pck = fck / lck_div / pck_div / 1000;
341
342 timings->pixel_clock = pck;
343
344 return 0;
345}
Tomi Valkeinen69b20482010-01-20 12:11:25 +0200346EXPORT_SYMBOL(dpi_check_timings);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300347
Tomi Valkeinen9d8232a2012-03-01 16:58:39 +0200348static int __init dpi_init_display(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300349{
350 DSSDBG("init_display\n");
351
Tomi Valkeinen5f42f2c2011-02-22 15:53:46 +0200352 if (cpu_is_omap34xx() && dpi.vdds_dsi_reg == NULL) {
353 struct regulator *vdds_dsi;
354
355 vdds_dsi = dss_get_vdds_dsi();
356
357 if (IS_ERR(vdds_dsi)) {
358 DSSERR("can't get VDDS_DSI regulator\n");
359 return PTR_ERR(vdds_dsi);
360 }
361
362 dpi.vdds_dsi_reg = vdds_dsi;
363 }
364
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530365 if (dpi_use_dsi_pll(dssdev)) {
366 enum omap_dss_clk_source dispc_fclk_src =
367 dssdev->clocks.dispc.dispc_fclk_src;
368 dpi.dsidev = dpi_get_dsidev(dispc_fclk_src);
369 }
370
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300371 return 0;
372}
373
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300374static void __init dpi_probe_pdata(struct platform_device *pdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300375{
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200376 struct omap_dss_board_info *pdata = pdev->dev.platform_data;
377 int i, r;
378
379 for (i = 0; i < pdata->num_devices; ++i) {
380 struct omap_dss_device *dssdev = pdata->devices[i];
381
382 if (dssdev->type != OMAP_DISPLAY_TYPE_DPI)
383 continue;
384
Tomi Valkeinen9d8232a2012-03-01 16:58:39 +0200385 r = dpi_init_display(dssdev);
386 if (r) {
387 DSSERR("device %s init failed: %d\n", dssdev->name, r);
388 continue;
389 }
390
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200391 r = omap_dss_register_device(dssdev, &pdev->dev, i);
392 if (r)
393 DSSERR("device %s register failed: %d\n",
394 dssdev->name, r);
395 }
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300396}
397
398static int __init omap_dpi_probe(struct platform_device *pdev)
399{
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530400 mutex_init(&dpi.lock);
401
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300402 dpi_probe_pdata(pdev);
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200403
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300404 return 0;
405}
406
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200407static int __exit omap_dpi_remove(struct platform_device *pdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300408{
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200409 omap_dss_unregister_child_devices(&pdev->dev);
410
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200411 return 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300412}
413
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200414static struct platform_driver omap_dpi_driver = {
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200415 .remove = __exit_p(omap_dpi_remove),
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200416 .driver = {
417 .name = "omapdss_dpi",
418 .owner = THIS_MODULE,
419 },
420};
421
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200422int __init dpi_init_platform_driver(void)
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200423{
Tomi Valkeinen61055d42012-03-07 12:53:38 +0200424 return platform_driver_probe(&omap_dpi_driver, omap_dpi_probe);
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200425}
426
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200427void __exit dpi_uninit_platform_driver(void)
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200428{
429 platform_driver_unregister(&omap_dpi_driver);
430}