blob: 6baeb04e60cc2599c7254c464e742010d677ad33 [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 Valkeinen13b1ba72012-09-28 10:03:03 +030032#include <linux/string.h>
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030033
Tomi Valkeinena0b38cc2011-05-11 14:05:07 +030034#include <video/omapdss.h>
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030035
36#include "dss.h"
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +053037#include "dss_features.h"
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030038
39static struct {
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +020040 struct regulator *vdds_dsi_reg;
Archit Tanejaa72b64b2011-05-12 17:26:26 +053041 struct platform_device *dsidev;
Archit Taneja5cf9a262012-06-29 14:19:13 +053042
Archit Tanejac8a5e4e2012-07-05 12:52:46 +053043 struct mutex lock;
44
Archit Tanejac4991442012-08-08 14:28:54 +053045 struct omap_video_timings timings;
Archit Taneja5cf9a262012-06-29 14:19:13 +053046 struct dss_lcd_mgr_config mgr_config;
Archit Tanejac6b393d2012-07-06 15:30:52 +053047 int data_lines;
Archit Taneja81b87f52012-09-26 16:30:49 +053048
49 struct omap_dss_output output;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030050} dpi;
51
Archit Tanejaa72b64b2011-05-12 17:26:26 +053052static struct platform_device *dpi_get_dsidev(enum omap_dss_clk_source clk)
53{
54 int dsi_module;
55
56 dsi_module = clk == OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC ? 0 : 1;
57
58 return dsi_get_dsidev_from_id(dsi_module);
59}
60
Archit Taneja7636b3b2011-04-12 13:52:26 +053061static bool dpi_use_dsi_pll(struct omap_dss_device *dssdev)
62{
63 if (dssdev->clocks.dispc.dispc_fclk_src ==
64 OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC ||
Archit Taneja5a8b5722011-05-12 17:26:29 +053065 dssdev->clocks.dispc.dispc_fclk_src ==
66 OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC ||
Archit Taneja7636b3b2011-04-12 13:52:26 +053067 dssdev->clocks.dispc.channel.lcd_clk_src ==
Archit Taneja5a8b5722011-05-12 17:26:29 +053068 OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC ||
69 dssdev->clocks.dispc.channel.lcd_clk_src ==
70 OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC)
Archit Taneja7636b3b2011-04-12 13:52:26 +053071 return true;
72 else
73 return false;
74}
75
Archit Taneja6d523e72012-06-21 09:33:55 +053076static int dpi_set_dsi_clk(struct omap_dss_device *dssdev,
Sumit Semwalff1b2cd2010-12-02 11:27:11 +000077 unsigned long pck_req, unsigned long *fck, int *lck_div,
78 int *pck_div)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030079{
Tomi Valkeinena5b83992012-10-22 16:58:36 +030080 struct omap_overlay_manager *mgr = dssdev->output->manager;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030081 struct dsi_clock_info dsi_cinfo;
82 struct dispc_clock_info dispc_cinfo;
83 int r;
84
Archit Taneja6d523e72012-06-21 09:33:55 +053085 r = dsi_pll_calc_clock_div_pck(dpi.dsidev, pck_req, &dsi_cinfo,
86 &dispc_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030087 if (r)
88 return r;
89
Archit Tanejaa72b64b2011-05-12 17:26:26 +053090 r = dsi_pll_set_clock_div(dpi.dsidev, &dsi_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030091 if (r)
92 return r;
93
Tomi Valkeinena5b83992012-10-22 16:58:36 +030094 dss_select_lcd_clk_source(mgr->id,
95 dssdev->clocks.dispc.channel.lcd_clk_src);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030096
Archit Taneja5cf9a262012-06-29 14:19:13 +053097 dpi.mgr_config.clock_info = dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030098
Archit Taneja1bb47832011-02-24 14:17:30 +053099 *fck = dsi_cinfo.dsi_pll_hsdiv_dispc_clk;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300100 *lck_div = dispc_cinfo.lck_div;
101 *pck_div = dispc_cinfo.pck_div;
102
103 return 0;
104}
Archit Taneja7636b3b2011-04-12 13:52:26 +0530105
Archit Taneja6d523e72012-06-21 09:33:55 +0530106static int dpi_set_dispc_clk(struct omap_dss_device *dssdev,
Sumit Semwalff1b2cd2010-12-02 11:27:11 +0000107 unsigned long pck_req, unsigned long *fck, int *lck_div,
108 int *pck_div)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300109{
110 struct dss_clock_info dss_cinfo;
111 struct dispc_clock_info dispc_cinfo;
112 int r;
113
Archit Taneja6d523e72012-06-21 09:33:55 +0530114 r = dss_calc_clock_div(pck_req, &dss_cinfo, &dispc_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300115 if (r)
116 return r;
117
118 r = dss_set_clock_div(&dss_cinfo);
119 if (r)
120 return r;
121
Archit Taneja5cf9a262012-06-29 14:19:13 +0530122 dpi.mgr_config.clock_info = dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300123
124 *fck = dss_cinfo.fck;
125 *lck_div = dispc_cinfo.lck_div;
126 *pck_div = dispc_cinfo.pck_div;
127
128 return 0;
129}
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300130
131static int dpi_set_mode(struct omap_dss_device *dssdev)
132{
Archit Tanejac4991442012-08-08 14:28:54 +0530133 struct omap_video_timings *t = &dpi.timings;
Archit Taneja5d512fc2012-09-07 17:53:38 +0530134 struct omap_overlay_manager *mgr = dssdev->output->manager;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530135 int lck_div = 0, pck_div = 0;
136 unsigned long fck = 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300137 unsigned long pck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300138 int r = 0;
139
Tomi Valkeinen8a3db402012-10-22 16:03:39 +0300140 if (dpi.dsidev)
Archit Taneja6d523e72012-06-21 09:33:55 +0530141 r = dpi_set_dsi_clk(dssdev, t->pixel_clock * 1000, &fck,
142 &lck_div, &pck_div);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530143 else
Archit Taneja6d523e72012-06-21 09:33:55 +0530144 r = dpi_set_dispc_clk(dssdev, t->pixel_clock * 1000, &fck,
145 &lck_div, &pck_div);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300146 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300147 return r;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300148
149 pck = fck / lck_div / pck_div / 1000;
150
151 if (pck != t->pixel_clock) {
152 DSSWARN("Could not find exact pixel clock. "
153 "Requested %d kHz, got %lu kHz\n",
154 t->pixel_clock, pck);
155
156 t->pixel_clock = pck;
157 }
158
Archit Taneja5d512fc2012-09-07 17:53:38 +0530159 dss_mgr_set_timings(mgr, t);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300160
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300161 return 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300162}
163
Archit Taneja5cf9a262012-06-29 14:19:13 +0530164static void dpi_config_lcd_manager(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300165{
Archit Taneja5d512fc2012-09-07 17:53:38 +0530166 struct omap_overlay_manager *mgr = dssdev->output->manager;
167
Archit Taneja5cf9a262012-06-29 14:19:13 +0530168 dpi.mgr_config.io_pad_mode = DSS_IO_PAD_MODE_BYPASS;
Archit Taneja569969d2011-08-22 17:41:57 +0530169
Archit Taneja5cf9a262012-06-29 14:19:13 +0530170 dpi.mgr_config.stallmode = false;
171 dpi.mgr_config.fifohandcheck = false;
172
Archit Tanejac6b393d2012-07-06 15:30:52 +0530173 dpi.mgr_config.video_port_width = dpi.data_lines;
Archit Taneja5cf9a262012-06-29 14:19:13 +0530174
175 dpi.mgr_config.lcden_sig_polarity = 0;
176
Archit Taneja5d512fc2012-09-07 17:53:38 +0530177 dss_mgr_set_lcd_config(mgr, &dpi.mgr_config);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300178}
179
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200180int omapdss_dpi_display_enable(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300181{
Archit Taneja5d512fc2012-09-07 17:53:38 +0530182 struct omap_dss_output *out = dssdev->output;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300183 int r;
184
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530185 mutex_lock(&dpi.lock);
186
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530187 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI) && !dpi.vdds_dsi_reg) {
Russell King40410712012-02-07 09:44:55 +0000188 DSSERR("no VDSS_DSI regulator\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530189 r = -ENODEV;
190 goto err_no_reg;
Russell King40410712012-02-07 09:44:55 +0000191 }
192
Archit Taneja5d512fc2012-09-07 17:53:38 +0530193 if (out == NULL || out->manager == NULL) {
194 DSSERR("failed to enable display: no output/manager\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530195 r = -ENODEV;
Archit Taneja5d512fc2012-09-07 17:53:38 +0530196 goto err_no_out_mgr;
Tomi Valkeinen05e1d602011-06-23 16:38:21 +0300197 }
198
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300199 r = omap_dss_start_device(dssdev);
200 if (r) {
201 DSSERR("failed to start device\n");
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300202 goto err_start_dev;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300203 }
204
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530205 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) {
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200206 r = regulator_enable(dpi.vdds_dsi_reg);
207 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300208 goto err_reg_enable;
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200209 }
210
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300211 r = dispc_runtime_get();
212 if (r)
213 goto err_get_dispc;
214
Tomi Valkeinende09e452012-09-21 12:09:54 +0300215 r = dss_dpi_select_source(dssdev->channel);
216 if (r)
217 goto err_src_sel;
218
Tomi Valkeinen8a3db402012-10-22 16:03:39 +0300219 if (dpi.dsidev) {
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300220 r = dsi_runtime_get(dpi.dsidev);
221 if (r)
222 goto err_get_dsi;
223
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530224 r = dsi_pll_init(dpi.dsidev, 0, 1);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530225 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300226 goto err_dsi_pll_init;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530227 }
228
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300229 r = dpi_set_mode(dssdev);
230 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300231 goto err_set_mode;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300232
Archit Taneja5cf9a262012-06-29 14:19:13 +0530233 dpi_config_lcd_manager(dssdev);
234
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300235 mdelay(2);
236
Archit Taneja5d512fc2012-09-07 17:53:38 +0530237 r = dss_mgr_enable(out->manager);
Tomi Valkeinen33ca2372011-11-21 13:42:58 +0200238 if (r)
239 goto err_mgr_enable;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300240
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530241 mutex_unlock(&dpi.lock);
242
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300243 return 0;
244
Tomi Valkeinen33ca2372011-11-21 13:42:58 +0200245err_mgr_enable:
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300246err_set_mode:
Tomi Valkeinen8a3db402012-10-22 16:03:39 +0300247 if (dpi.dsidev)
Tomi Valkeinen19077a72011-05-18 11:33:44 +0300248 dsi_pll_uninit(dpi.dsidev, true);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300249err_dsi_pll_init:
Tomi Valkeinen8a3db402012-10-22 16:03:39 +0300250 if (dpi.dsidev)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300251 dsi_runtime_put(dpi.dsidev);
252err_get_dsi:
Tomi Valkeinende09e452012-09-21 12:09:54 +0300253err_src_sel:
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300254 dispc_runtime_put();
255err_get_dispc:
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530256 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI))
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200257 regulator_disable(dpi.vdds_dsi_reg);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300258err_reg_enable:
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300259 omap_dss_stop_device(dssdev);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300260err_start_dev:
Archit Taneja5d512fc2012-09-07 17:53:38 +0530261err_no_out_mgr:
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530262err_no_reg:
263 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300264 return r;
265}
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200266EXPORT_SYMBOL(omapdss_dpi_display_enable);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300267
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200268void omapdss_dpi_display_disable(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300269{
Archit Taneja5d512fc2012-09-07 17:53:38 +0530270 struct omap_overlay_manager *mgr = dssdev->output->manager;
271
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530272 mutex_lock(&dpi.lock);
273
Archit Taneja5d512fc2012-09-07 17:53:38 +0530274 dss_mgr_disable(mgr);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300275
Tomi Valkeinen8a3db402012-10-22 16:03:39 +0300276 if (dpi.dsidev) {
Tomi Valkeinena5b83992012-10-22 16:58:36 +0300277 dss_select_lcd_clk_source(mgr->id, OMAP_DSS_CLK_SRC_FCK);
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530278 dsi_pll_uninit(dpi.dsidev, true);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300279 dsi_runtime_put(dpi.dsidev);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530280 }
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300281
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300282 dispc_runtime_put();
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300283
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530284 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI))
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200285 regulator_disable(dpi.vdds_dsi_reg);
286
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300287 omap_dss_stop_device(dssdev);
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530288
289 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300290}
Tomi Valkeinen37ac60e2010-01-12 15:12:07 +0200291EXPORT_SYMBOL(omapdss_dpi_display_disable);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300292
Archit Tanejac4991442012-08-08 14:28:54 +0530293void omapdss_dpi_set_timings(struct omap_dss_device *dssdev,
294 struct omap_video_timings *timings)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300295{
296 DSSDBG("dpi_set_timings\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530297
298 mutex_lock(&dpi.lock);
299
Archit Tanejac4991442012-08-08 14:28:54 +0530300 dpi.timings = *timings;
Archit Tanejac4991442012-08-08 14:28:54 +0530301
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530302 mutex_unlock(&dpi.lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300303}
Archit Tanejac4991442012-08-08 14:28:54 +0530304EXPORT_SYMBOL(omapdss_dpi_set_timings);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300305
Tomi Valkeinen69b20482010-01-20 12:11:25 +0200306int dpi_check_timings(struct omap_dss_device *dssdev,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300307 struct omap_video_timings *timings)
308{
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300309 int r;
Archit Taneja5d512fc2012-09-07 17:53:38 +0530310 struct omap_overlay_manager *mgr = dssdev->output->manager;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300311 int lck_div, pck_div;
312 unsigned long fck;
313 unsigned long pck;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530314 struct dispc_clock_info dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300315
Archit Taneja5d512fc2012-09-07 17:53:38 +0530316 if (dss_mgr_check_timings(mgr, timings))
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300317 return -EINVAL;
318
319 if (timings->pixel_clock == 0)
320 return -EINVAL;
321
Tomi Valkeinen8a3db402012-10-22 16:03:39 +0300322 if (dpi.dsidev) {
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300323 struct dsi_clock_info dsi_cinfo;
Archit Taneja6d523e72012-06-21 09:33:55 +0530324 r = dsi_pll_calc_clock_div_pck(dpi.dsidev,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300325 timings->pixel_clock * 1000,
326 &dsi_cinfo, &dispc_cinfo);
327
328 if (r)
329 return r;
330
Archit Taneja1bb47832011-02-24 14:17:30 +0530331 fck = dsi_cinfo.dsi_pll_hsdiv_dispc_clk;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530332 } else {
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300333 struct dss_clock_info dss_cinfo;
Archit Taneja6d523e72012-06-21 09:33:55 +0530334 r = dss_calc_clock_div(timings->pixel_clock * 1000,
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300335 &dss_cinfo, &dispc_cinfo);
336
337 if (r)
338 return r;
339
340 fck = dss_cinfo.fck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300341 }
Archit Taneja7636b3b2011-04-12 13:52:26 +0530342
343 lck_div = dispc_cinfo.lck_div;
344 pck_div = dispc_cinfo.pck_div;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300345
346 pck = fck / lck_div / pck_div / 1000;
347
348 timings->pixel_clock = pck;
349
350 return 0;
351}
Tomi Valkeinen69b20482010-01-20 12:11:25 +0200352EXPORT_SYMBOL(dpi_check_timings);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300353
Archit Tanejac6b393d2012-07-06 15:30:52 +0530354void omapdss_dpi_set_data_lines(struct omap_dss_device *dssdev, int data_lines)
355{
356 mutex_lock(&dpi.lock);
357
358 dpi.data_lines = data_lines;
359
360 mutex_unlock(&dpi.lock);
361}
362EXPORT_SYMBOL(omapdss_dpi_set_data_lines);
363
Tomi Valkeinen60616752012-10-30 12:57:43 +0200364static int __init dpi_verify_dsi_pll(struct platform_device *dsidev)
365{
366 int r;
367
368 /* do initial setup with the PLL to see if it is operational */
369
370 r = dsi_runtime_get(dsidev);
371 if (r)
372 return r;
373
374 r = dsi_pll_init(dsidev, 0, 1);
375 if (r) {
376 dsi_runtime_put(dsidev);
377 return r;
378 }
379
380 dsi_pll_uninit(dsidev, true);
381 dsi_runtime_put(dsidev);
382
383 return 0;
384}
385
Tomi Valkeinen9d8232a2012-03-01 16:58:39 +0200386static int __init dpi_init_display(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300387{
388 DSSDBG("init_display\n");
389
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530390 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI) &&
391 dpi.vdds_dsi_reg == NULL) {
Tomi Valkeinen5f42f2c2011-02-22 15:53:46 +0200392 struct regulator *vdds_dsi;
393
394 vdds_dsi = dss_get_vdds_dsi();
395
396 if (IS_ERR(vdds_dsi)) {
397 DSSERR("can't get VDDS_DSI regulator\n");
398 return PTR_ERR(vdds_dsi);
399 }
400
401 dpi.vdds_dsi_reg = vdds_dsi;
402 }
403
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530404 if (dpi_use_dsi_pll(dssdev)) {
405 enum omap_dss_clk_source dispc_fclk_src =
406 dssdev->clocks.dispc.dispc_fclk_src;
407 dpi.dsidev = dpi_get_dsidev(dispc_fclk_src);
Tomi Valkeinen60616752012-10-30 12:57:43 +0200408
409 if (dpi_verify_dsi_pll(dpi.dsidev)) {
410 dpi.dsidev = NULL;
411 DSSWARN("DSI PLL not operational\n");
412 }
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530413 }
414
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300415 return 0;
416}
417
Tomi Valkeinen15216532012-09-06 14:29:31 +0300418static struct omap_dss_device * __init dpi_find_dssdev(struct platform_device *pdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300419{
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200420 struct omap_dss_board_info *pdata = pdev->dev.platform_data;
Tomi Valkeinen2bbcce52012-10-29 12:40:46 +0200421 const char *def_disp_name = omapdss_get_default_display_name();
Tomi Valkeinen15216532012-09-06 14:29:31 +0300422 struct omap_dss_device *def_dssdev;
423 int i;
424
425 def_dssdev = NULL;
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200426
427 for (i = 0; i < pdata->num_devices; ++i) {
428 struct omap_dss_device *dssdev = pdata->devices[i];
429
430 if (dssdev->type != OMAP_DISPLAY_TYPE_DPI)
431 continue;
432
Tomi Valkeinen15216532012-09-06 14:29:31 +0300433 if (def_dssdev == NULL)
434 def_dssdev = dssdev;
Tomi Valkeinen9d8232a2012-03-01 16:58:39 +0200435
Tomi Valkeinen15216532012-09-06 14:29:31 +0300436 if (def_disp_name != NULL &&
437 strcmp(dssdev->name, def_disp_name) == 0) {
438 def_dssdev = dssdev;
439 break;
440 }
441 }
442
443 return def_dssdev;
444}
445
Tomi Valkeinen52744842012-09-10 13:58:29 +0300446static void __init dpi_probe_pdata(struct platform_device *dpidev)
Tomi Valkeinen15216532012-09-06 14:29:31 +0300447{
Tomi Valkeinen52744842012-09-10 13:58:29 +0300448 struct omap_dss_device *plat_dssdev;
Tomi Valkeinen15216532012-09-06 14:29:31 +0300449 struct omap_dss_device *dssdev;
450 int r;
451
Tomi Valkeinen52744842012-09-10 13:58:29 +0300452 plat_dssdev = dpi_find_dssdev(dpidev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300453
Tomi Valkeinen52744842012-09-10 13:58:29 +0300454 if (!plat_dssdev)
455 return;
456
457 dssdev = dss_alloc_and_init_device(&dpidev->dev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300458 if (!dssdev)
459 return;
460
Tomi Valkeinen52744842012-09-10 13:58:29 +0300461 dss_copy_device_pdata(dssdev, plat_dssdev);
462
Tomi Valkeinen15216532012-09-06 14:29:31 +0300463 r = dpi_init_display(dssdev);
464 if (r) {
465 DSSERR("device %s init failed: %d\n", dssdev->name, r);
Tomi Valkeinen52744842012-09-10 13:58:29 +0300466 dss_put_device(dssdev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300467 return;
468 }
469
Tomi Valkeinen52744842012-09-10 13:58:29 +0300470 r = dss_add_device(dssdev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300471 if (r) {
472 DSSERR("device %s register failed: %d\n", dssdev->name, r);
Tomi Valkeinen52744842012-09-10 13:58:29 +0300473 dss_put_device(dssdev);
Tomi Valkeinen15216532012-09-06 14:29:31 +0300474 return;
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200475 }
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300476}
477
Archit Taneja81b87f52012-09-26 16:30:49 +0530478static void __init dpi_init_output(struct platform_device *pdev)
479{
480 struct omap_dss_output *out = &dpi.output;
481
482 out->pdev = pdev;
483 out->id = OMAP_DSS_OUTPUT_DPI;
484 out->type = OMAP_DISPLAY_TYPE_DPI;
485
486 dss_register_output(out);
487}
488
489static void __exit dpi_uninit_output(struct platform_device *pdev)
490{
491 struct omap_dss_output *out = &dpi.output;
492
493 dss_unregister_output(out);
494}
495
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300496static int __init omap_dpi_probe(struct platform_device *pdev)
497{
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530498 mutex_init(&dpi.lock);
499
Archit Taneja81b87f52012-09-26 16:30:49 +0530500 dpi_init_output(pdev);
501
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300502 dpi_probe_pdata(pdev);
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200503
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300504 return 0;
505}
506
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200507static int __exit omap_dpi_remove(struct platform_device *pdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300508{
Tomi Valkeinen52744842012-09-10 13:58:29 +0300509 dss_unregister_child_devices(&pdev->dev);
Tomi Valkeinen35deca32012-03-01 15:45:53 +0200510
Archit Taneja81b87f52012-09-26 16:30:49 +0530511 dpi_uninit_output(pdev);
512
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200513 return 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300514}
515
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200516static struct platform_driver omap_dpi_driver = {
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200517 .remove = __exit_p(omap_dpi_remove),
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200518 .driver = {
519 .name = "omapdss_dpi",
520 .owner = THIS_MODULE,
521 },
522};
523
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200524int __init dpi_init_platform_driver(void)
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200525{
Tomi Valkeinen61055d42012-03-07 12:53:38 +0200526 return platform_driver_probe(&omap_dpi_driver, omap_dpi_probe);
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200527}
528
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200529void __exit dpi_uninit_platform_driver(void)
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200530{
531 platform_driver_unregister(&omap_dpi_driver);
532}