blob: d73a549050e4f980552bb0401d2aadb9ce846f2a [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
35#include "dss.h"
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +053036#include "dss_features.h"
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030037
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 Tanejac4991442012-08-08 14:28:54 +053044 struct omap_video_timings timings;
Archit Taneja5cf9a262012-06-29 14:19:13 +053045 struct dss_lcd_mgr_config mgr_config;
Archit Tanejac6b393d2012-07-06 15:30:52 +053046 int data_lines;
Archit Taneja81b87f52012-09-26 16:30:49 +053047
48 struct omap_dss_output output;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030049} dpi;
50
Archit Tanejaa72b64b2011-05-12 17:26:26 +053051static 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
Archit Taneja7636b3b2011-04-12 13:52:26 +053060static 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 ||
Archit Taneja5a8b5722011-05-12 17:26:29 +053064 dssdev->clocks.dispc.dispc_fclk_src ==
65 OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC ||
Archit Taneja7636b3b2011-04-12 13:52:26 +053066 dssdev->clocks.dispc.channel.lcd_clk_src ==
Archit Taneja5a8b5722011-05-12 17:26:29 +053067 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)
Archit Taneja7636b3b2011-04-12 13:52:26 +053070 return true;
71 else
72 return false;
73}
74
Archit Taneja6d523e72012-06-21 09:33:55 +053075static int dpi_set_dsi_clk(struct omap_dss_device *dssdev,
Sumit Semwalff1b2cd2010-12-02 11:27:11 +000076 unsigned long pck_req, unsigned long *fck, int *lck_div,
77 int *pck_div)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030078{
79 struct dsi_clock_info dsi_cinfo;
80 struct dispc_clock_info dispc_cinfo;
81 int r;
82
Archit Taneja6d523e72012-06-21 09:33:55 +053083 r = dsi_pll_calc_clock_div_pck(dpi.dsidev, pck_req, &dsi_cinfo,
84 &dispc_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030085 if (r)
86 return r;
87
Archit Tanejaa72b64b2011-05-12 17:26:26 +053088 r = dsi_pll_set_clock_div(dpi.dsidev, &dsi_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030089 if (r)
90 return r;
91
Archit Tanejae8881662011-04-12 13:52:24 +053092 dss_select_dispc_clk_source(dssdev->clocks.dispc.dispc_fclk_src);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030093
Archit Taneja5cf9a262012-06-29 14:19:13 +053094 dpi.mgr_config.clock_info = dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030095
Archit Taneja1bb47832011-02-24 14:17:30 +053096 *fck = dsi_cinfo.dsi_pll_hsdiv_dispc_clk;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030097 *lck_div = dispc_cinfo.lck_div;
98 *pck_div = dispc_cinfo.pck_div;
99
100 return 0;
101}
Archit Taneja7636b3b2011-04-12 13:52:26 +0530102
Archit Taneja6d523e72012-06-21 09:33:55 +0530103static int dpi_set_dispc_clk(struct omap_dss_device *dssdev,
Sumit Semwalff1b2cd2010-12-02 11:27:11 +0000104 unsigned long pck_req, unsigned long *fck, int *lck_div,
105 int *pck_div)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300106{
107 struct dss_clock_info dss_cinfo;
108 struct dispc_clock_info dispc_cinfo;
109 int r;
110
Archit Taneja6d523e72012-06-21 09:33:55 +0530111 r = dss_calc_clock_div(pck_req, &dss_cinfo, &dispc_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300112 if (r)
113 return r;
114
115 r = dss_set_clock_div(&dss_cinfo);
116 if (r)
117 return r;
118
Archit Taneja5cf9a262012-06-29 14:19:13 +0530119 dpi.mgr_config.clock_info = dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300120
121 *fck = dss_cinfo.fck;
122 *lck_div = dispc_cinfo.lck_div;
123 *pck_div = dispc_cinfo.pck_div;
124
125 return 0;
126}
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300127
128static int dpi_set_mode(struct omap_dss_device *dssdev)
129{
Archit Tanejac4991442012-08-08 14:28:54 +0530130 struct omap_video_timings *t = &dpi.timings;
Archit Taneja5d512fc2012-09-07 17:53:38 +0530131 struct omap_overlay_manager *mgr = dssdev->output->manager;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530132 int lck_div = 0, pck_div = 0;
133 unsigned long fck = 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300134 unsigned long pck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300135 int r = 0;
136
Archit Taneja7636b3b2011-04-12 13:52:26 +0530137 if (dpi_use_dsi_pll(dssdev))
Archit Taneja6d523e72012-06-21 09:33:55 +0530138 r = dpi_set_dsi_clk(dssdev, t->pixel_clock * 1000, &fck,
139 &lck_div, &pck_div);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530140 else
Archit Taneja6d523e72012-06-21 09:33:55 +0530141 r = dpi_set_dispc_clk(dssdev, t->pixel_clock * 1000, &fck,
142 &lck_div, &pck_div);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300143 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300144 return r;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300145
146 pck = fck / lck_div / pck_div / 1000;
147
148 if (pck != t->pixel_clock) {
149 DSSWARN("Could not find exact pixel clock. "
150 "Requested %d kHz, got %lu kHz\n",
151 t->pixel_clock, pck);
152
153 t->pixel_clock = pck;
154 }
155
Archit Taneja5d512fc2012-09-07 17:53:38 +0530156 dss_mgr_set_timings(mgr, t);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300157
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300158 return 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300159}
160
Archit Taneja5cf9a262012-06-29 14:19:13 +0530161static void dpi_config_lcd_manager(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300162{
Archit Taneja5d512fc2012-09-07 17:53:38 +0530163 struct omap_overlay_manager *mgr = dssdev->output->manager;
164
Archit Taneja5cf9a262012-06-29 14:19:13 +0530165 dpi.mgr_config.io_pad_mode = DSS_IO_PAD_MODE_BYPASS;
Archit Taneja569969d2011-08-22 17:41:57 +0530166
Archit Taneja5cf9a262012-06-29 14:19:13 +0530167 dpi.mgr_config.stallmode = false;
168 dpi.mgr_config.fifohandcheck = false;
169
Archit Tanejac6b393d2012-07-06 15:30:52 +0530170 dpi.mgr_config.video_port_width = dpi.data_lines;
Archit Taneja5cf9a262012-06-29 14:19:13 +0530171
172 dpi.mgr_config.lcden_sig_polarity = 0;
173
Archit Taneja5d512fc2012-09-07 17:53:38 +0530174 dss_mgr_set_lcd_config(mgr, &dpi.mgr_config);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300175}
176
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200177int omapdss_dpi_display_enable(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300178{
Archit Taneja5d512fc2012-09-07 17:53:38 +0530179 struct omap_dss_output *out = dssdev->output;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300180 int r;
181
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530182 mutex_lock(&dpi.lock);
183
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530184 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI) && !dpi.vdds_dsi_reg) {
Russell King40410712012-02-07 09:44:55 +0000185 DSSERR("no VDSS_DSI regulator\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530186 r = -ENODEV;
187 goto err_no_reg;
Russell King40410712012-02-07 09:44:55 +0000188 }
189
Archit Taneja5d512fc2012-09-07 17:53:38 +0530190 if (out == NULL || out->manager == NULL) {
191 DSSERR("failed to enable display: no output/manager\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530192 r = -ENODEV;
Archit Taneja5d512fc2012-09-07 17:53:38 +0530193 goto err_no_out_mgr;
Tomi Valkeinen05e1d602011-06-23 16:38:21 +0300194 }
195
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300196 r = omap_dss_start_device(dssdev);
197 if (r) {
198 DSSERR("failed to start device\n");
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300199 goto err_start_dev;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300200 }
201
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530202 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) {
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200203 r = regulator_enable(dpi.vdds_dsi_reg);
204 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300205 goto err_reg_enable;
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200206 }
207
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300208 r = dispc_runtime_get();
209 if (r)
210 goto err_get_dispc;
211
Tomi Valkeinende09e452012-09-21 12:09:54 +0300212 r = dss_dpi_select_source(dssdev->channel);
213 if (r)
214 goto err_src_sel;
215
Archit Taneja7636b3b2011-04-12 13:52:26 +0530216 if (dpi_use_dsi_pll(dssdev)) {
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300217 r = dsi_runtime_get(dpi.dsidev);
218 if (r)
219 goto err_get_dsi;
220
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530221 r = dsi_pll_init(dpi.dsidev, 0, 1);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530222 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300223 goto err_dsi_pll_init;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530224 }
225
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300226 r = dpi_set_mode(dssdev);
227 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300228 goto err_set_mode;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300229
Archit Taneja5cf9a262012-06-29 14:19:13 +0530230 dpi_config_lcd_manager(dssdev);
231
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300232 mdelay(2);
233
Archit Taneja5d512fc2012-09-07 17:53:38 +0530234 r = dss_mgr_enable(out->manager);
Tomi Valkeinen33ca2372011-11-21 13:42:58 +0200235 if (r)
236 goto err_mgr_enable;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300237
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530238 mutex_unlock(&dpi.lock);
239
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300240 return 0;
241
Tomi Valkeinen33ca2372011-11-21 13:42:58 +0200242err_mgr_enable:
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300243err_set_mode:
Archit Taneja7636b3b2011-04-12 13:52:26 +0530244 if (dpi_use_dsi_pll(dssdev))
Tomi Valkeinen19077a72011-05-18 11:33:44 +0300245 dsi_pll_uninit(dpi.dsidev, true);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300246err_dsi_pll_init:
247 if (dpi_use_dsi_pll(dssdev))
248 dsi_runtime_put(dpi.dsidev);
249err_get_dsi:
Tomi Valkeinende09e452012-09-21 12:09:54 +0300250err_src_sel:
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300251 dispc_runtime_put();
252err_get_dispc:
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530253 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI))
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200254 regulator_disable(dpi.vdds_dsi_reg);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300255err_reg_enable:
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300256 omap_dss_stop_device(dssdev);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300257err_start_dev:
Archit Taneja5d512fc2012-09-07 17:53:38 +0530258err_no_out_mgr:
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530259err_no_reg:
260 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300261 return r;
262}
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200263EXPORT_SYMBOL(omapdss_dpi_display_enable);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300264
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200265void omapdss_dpi_display_disable(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300266{
Archit Taneja5d512fc2012-09-07 17:53:38 +0530267 struct omap_overlay_manager *mgr = dssdev->output->manager;
268
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530269 mutex_lock(&dpi.lock);
270
Archit Taneja5d512fc2012-09-07 17:53:38 +0530271 dss_mgr_disable(mgr);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300272
Archit Taneja7636b3b2011-04-12 13:52:26 +0530273 if (dpi_use_dsi_pll(dssdev)) {
274 dss_select_dispc_clk_source(OMAP_DSS_CLK_SRC_FCK);
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530275 dsi_pll_uninit(dpi.dsidev, true);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300276 dsi_runtime_put(dpi.dsidev);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530277 }
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300278
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300279 dispc_runtime_put();
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300280
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530281 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI))
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200282 regulator_disable(dpi.vdds_dsi_reg);
283
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300284 omap_dss_stop_device(dssdev);
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530285
286 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300287}
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200288EXPORT_SYMBOL(omapdss_dpi_display_disable);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300289
Archit Tanejac4991442012-08-08 14:28:54 +0530290void omapdss_dpi_set_timings(struct omap_dss_device *dssdev,
291 struct omap_video_timings *timings)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300292{
293 DSSDBG("dpi_set_timings\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530294
295 mutex_lock(&dpi.lock);
296
Archit Tanejac4991442012-08-08 14:28:54 +0530297 dpi.timings = *timings;
Archit Tanejac4991442012-08-08 14:28:54 +0530298
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530299 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300300}
Archit Tanejac4991442012-08-08 14:28:54 +0530301EXPORT_SYMBOL(omapdss_dpi_set_timings);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300302
Tomi Valkeinen69b20482010-01-20 12:11:25 +0200303int dpi_check_timings(struct omap_dss_device *dssdev,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300304 struct omap_video_timings *timings)
305{
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300306 int r;
Archit Taneja5d512fc2012-09-07 17:53:38 +0530307 struct omap_overlay_manager *mgr = dssdev->output->manager;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300308 int lck_div, pck_div;
309 unsigned long fck;
310 unsigned long pck;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530311 struct dispc_clock_info dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300312
Archit Taneja5d512fc2012-09-07 17:53:38 +0530313 if (dss_mgr_check_timings(mgr, timings))
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300314 return -EINVAL;
315
316 if (timings->pixel_clock == 0)
317 return -EINVAL;
318
Archit Taneja7636b3b2011-04-12 13:52:26 +0530319 if (dpi_use_dsi_pll(dssdev)) {
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300320 struct dsi_clock_info dsi_cinfo;
Archit Taneja6d523e72012-06-21 09:33:55 +0530321 r = dsi_pll_calc_clock_div_pck(dpi.dsidev,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300322 timings->pixel_clock * 1000,
323 &dsi_cinfo, &dispc_cinfo);
324
325 if (r)
326 return r;
327
Archit Taneja1bb47832011-02-24 14:17:30 +0530328 fck = dsi_cinfo.dsi_pll_hsdiv_dispc_clk;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530329 } else {
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300330 struct dss_clock_info dss_cinfo;
Archit Taneja6d523e72012-06-21 09:33:55 +0530331 r = dss_calc_clock_div(timings->pixel_clock * 1000,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300332 &dss_cinfo, &dispc_cinfo);
333
334 if (r)
335 return r;
336
337 fck = dss_cinfo.fck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300338 }
Archit Taneja7636b3b2011-04-12 13:52:26 +0530339
340 lck_div = dispc_cinfo.lck_div;
341 pck_div = dispc_cinfo.pck_div;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300342
343 pck = fck / lck_div / pck_div / 1000;
344
345 timings->pixel_clock = pck;
346
347 return 0;
348}
Tomi Valkeinen69b20482010-01-20 12:11:25 +0200349EXPORT_SYMBOL(dpi_check_timings);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300350
Archit Tanejac6b393d2012-07-06 15:30:52 +0530351void omapdss_dpi_set_data_lines(struct omap_dss_device *dssdev, int data_lines)
352{
353 mutex_lock(&dpi.lock);
354
355 dpi.data_lines = data_lines;
356
357 mutex_unlock(&dpi.lock);
358}
359EXPORT_SYMBOL(omapdss_dpi_set_data_lines);
360
Tomi Valkeinen9d8232a2012-03-01 16:58:39 +0200361static int __init dpi_init_display(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300362{
363 DSSDBG("init_display\n");
364
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530365 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI) &&
366 dpi.vdds_dsi_reg == NULL) {
Tomi Valkeinen5f42f2c2011-02-22 15:53:46 +0200367 struct regulator *vdds_dsi;
368
369 vdds_dsi = dss_get_vdds_dsi();
370
371 if (IS_ERR(vdds_dsi)) {
372 DSSERR("can't get VDDS_DSI regulator\n");
373 return PTR_ERR(vdds_dsi);
374 }
375
376 dpi.vdds_dsi_reg = vdds_dsi;
377 }
378
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530379 if (dpi_use_dsi_pll(dssdev)) {
380 enum omap_dss_clk_source dispc_fclk_src =
381 dssdev->clocks.dispc.dispc_fclk_src;
382 dpi.dsidev = dpi_get_dsidev(dispc_fclk_src);
383 }
384
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300385 return 0;
386}
387
Tomi Valkeinen15216532012-09-06 14:29:31 +0300388static struct omap_dss_device * __init dpi_find_dssdev(struct platform_device *pdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300389{
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200390 struct omap_dss_board_info *pdata = pdev->dev.platform_data;
Tomi Valkeinen15216532012-09-06 14:29:31 +0300391 const char *def_disp_name = dss_get_default_display_name();
392 struct omap_dss_device *def_dssdev;
393 int i;
394
395 def_dssdev = NULL;
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200396
397 for (i = 0; i < pdata->num_devices; ++i) {
398 struct omap_dss_device *dssdev = pdata->devices[i];
399
400 if (dssdev->type != OMAP_DISPLAY_TYPE_DPI)
401 continue;
402
Tomi Valkeinen15216532012-09-06 14:29:31 +0300403 if (def_dssdev == NULL)
404 def_dssdev = dssdev;
Tomi Valkeinen9d8232a2012-03-01 16:58:39 +0200405
Tomi Valkeinen15216532012-09-06 14:29:31 +0300406 if (def_disp_name != NULL &&
407 strcmp(dssdev->name, def_disp_name) == 0) {
408 def_dssdev = dssdev;
409 break;
410 }
411 }
412
413 return def_dssdev;
414}
415
Tomi Valkeinen52744842012-09-10 13:58:29 +0300416static void __init dpi_probe_pdata(struct platform_device *dpidev)
Tomi Valkeinen15216532012-09-06 14:29:31 +0300417{
Tomi Valkeinen52744842012-09-10 13:58:29 +0300418 struct omap_dss_device *plat_dssdev;
Tomi Valkeinen15216532012-09-06 14:29:31 +0300419 struct omap_dss_device *dssdev;
420 int r;
421
Tomi Valkeinen52744842012-09-10 13:58:29 +0300422 plat_dssdev = dpi_find_dssdev(dpidev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300423
Tomi Valkeinen52744842012-09-10 13:58:29 +0300424 if (!plat_dssdev)
425 return;
426
427 dssdev = dss_alloc_and_init_device(&dpidev->dev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300428 if (!dssdev)
429 return;
430
Tomi Valkeinen52744842012-09-10 13:58:29 +0300431 dss_copy_device_pdata(dssdev, plat_dssdev);
432
Tomi Valkeinen15216532012-09-06 14:29:31 +0300433 r = dpi_init_display(dssdev);
434 if (r) {
435 DSSERR("device %s init failed: %d\n", dssdev->name, r);
Tomi Valkeinen52744842012-09-10 13:58:29 +0300436 dss_put_device(dssdev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300437 return;
438 }
439
Tomi Valkeinen52744842012-09-10 13:58:29 +0300440 r = dss_add_device(dssdev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300441 if (r) {
442 DSSERR("device %s register failed: %d\n", dssdev->name, r);
Tomi Valkeinen52744842012-09-10 13:58:29 +0300443 dss_put_device(dssdev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300444 return;
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200445 }
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300446}
447
Archit Taneja81b87f52012-09-26 16:30:49 +0530448static void __init dpi_init_output(struct platform_device *pdev)
449{
450 struct omap_dss_output *out = &dpi.output;
451
452 out->pdev = pdev;
453 out->id = OMAP_DSS_OUTPUT_DPI;
454 out->type = OMAP_DISPLAY_TYPE_DPI;
455
456 dss_register_output(out);
457}
458
459static void __exit dpi_uninit_output(struct platform_device *pdev)
460{
461 struct omap_dss_output *out = &dpi.output;
462
463 dss_unregister_output(out);
464}
465
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300466static int __init omap_dpi_probe(struct platform_device *pdev)
467{
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530468 mutex_init(&dpi.lock);
469
Archit Taneja81b87f52012-09-26 16:30:49 +0530470 dpi_init_output(pdev);
471
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300472 dpi_probe_pdata(pdev);
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200473
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300474 return 0;
475}
476
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200477static int __exit omap_dpi_remove(struct platform_device *pdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300478{
Tomi Valkeinen52744842012-09-10 13:58:29 +0300479 dss_unregister_child_devices(&pdev->dev);
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200480
Archit Taneja81b87f52012-09-26 16:30:49 +0530481 dpi_uninit_output(pdev);
482
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200483 return 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300484}
485
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200486static struct platform_driver omap_dpi_driver = {
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200487 .remove = __exit_p(omap_dpi_remove),
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200488 .driver = {
489 .name = "omapdss_dpi",
490 .owner = THIS_MODULE,
491 },
492};
493
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200494int __init dpi_init_platform_driver(void)
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200495{
Tomi Valkeinen61055d42012-03-07 12:53:38 +0200496 return platform_driver_probe(&omap_dpi_driver, omap_dpi_probe);
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200497}
498
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200499void __exit dpi_uninit_platform_driver(void)
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200500{
501 platform_driver_unregister(&omap_dpi_driver);
502}