blob: 51d90a8a61cdff32d7db3c327c96e7cca0f8bcd6 [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 Valkeinen2ecef242013-12-16 15:13:24 +020033#include <linux/of.h>
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +030034#include <linux/clk.h>
Tomi Valkeinen736e60d2015-06-04 15:22:23 +030035#include <linux/component.h>
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030036
Peter Ujfalusi32043da2016-05-27 14:40:49 +030037#include "omapdss.h"
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030038#include "dss.h"
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +053039#include "dss_features.h"
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030040
Archit Taneja630d2d02014-05-30 16:26:22 +053041struct dpi_data {
Tomi Valkeinen00df43b2013-03-19 11:33:52 +020042 struct platform_device *pdev;
43
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +020044 struct regulator *vdds_dsi_reg;
Tomi Valkeinen331e6072016-05-17 16:08:54 +030045 enum dss_clk_source clk_src;
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +030046 struct dss_pll *pll;
Archit Taneja5cf9a262012-06-29 14:19:13 +053047
Archit Tanejac8a5e4e2012-07-05 12:52:46 +053048 struct mutex lock;
49
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +030050 struct videomode vm;
Archit Taneja5cf9a262012-06-29 14:19:13 +053051 struct dss_lcd_mgr_config mgr_config;
Archit Tanejac6b393d2012-07-06 15:30:52 +053052 int data_lines;
Archit Taneja81b87f52012-09-26 16:30:49 +053053
Tomi Valkeinen1f68d9c2013-04-19 15:09:34 +030054 struct omap_dss_device output;
Tomi Valkeinen2ecef242013-12-16 15:13:24 +020055
56 bool port_initialized;
Archit Taneja630d2d02014-05-30 16:26:22 +053057};
58
Archit Taneja2ac6a1a2014-06-01 12:47:44 +053059static struct dpi_data *dpi_get_data_from_dssdev(struct omap_dss_device *dssdev)
60{
61 return container_of(dssdev, struct dpi_data, output);
62}
63
Archit Taneja80eb6752014-06-02 14:11:51 +053064/* only used in non-DT mode */
Archit Taneja2ac6a1a2014-06-01 12:47:44 +053065static struct dpi_data *dpi_get_data_from_pdev(struct platform_device *pdev)
66{
67 return dev_get_drvdata(&pdev->dev);
68}
Tomi Valkeinen553c48c2009-08-07 13:15:50 +030069
Tomi Valkeinen7bbdef22016-08-10 11:04:29 +030070static enum dss_clk_source dpi_get_clk_src_dra7xx(enum omap_channel channel)
71{
72 /*
73 * Possible clock sources:
74 * LCD1: FCK/PLL1_1/HDMI_PLL
75 * LCD2: FCK/PLL1_3/HDMI_PLL (DRA74x: PLL2_3)
76 * LCD3: FCK/PLL1_3/HDMI_PLL (DRA74x: PLL2_1)
77 */
78
79 switch (channel) {
80 case OMAP_DSS_CHANNEL_LCD:
81 {
82 if (dss_pll_find_by_src(DSS_CLK_SRC_PLL1_1))
83 return DSS_CLK_SRC_PLL1_1;
84 break;
85 }
86 case OMAP_DSS_CHANNEL_LCD2:
87 {
88 if (dss_pll_find_by_src(DSS_CLK_SRC_PLL1_3))
89 return DSS_CLK_SRC_PLL1_3;
90 if (dss_pll_find_by_src(DSS_CLK_SRC_PLL2_3))
91 return DSS_CLK_SRC_PLL2_3;
92 break;
93 }
94 case OMAP_DSS_CHANNEL_LCD3:
95 {
96 if (dss_pll_find_by_src(DSS_CLK_SRC_PLL2_1))
97 return DSS_CLK_SRC_PLL2_1;
98 if (dss_pll_find_by_src(DSS_CLK_SRC_PLL1_3))
99 return DSS_CLK_SRC_PLL1_3;
100 break;
101 }
102 default:
103 break;
104 }
105
106 return DSS_CLK_SRC_FCK;
107}
108
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300109static enum dss_clk_source dpi_get_clk_src(enum omap_channel channel)
Archit Tanejaa72b64b2011-05-12 17:26:26 +0530110{
Tomi Valkeinenbd0f5cc2012-12-13 14:21:30 +0200111 /*
112 * XXX we can't currently use DSI PLL for DPI with OMAP3, as the DSI PLL
113 * would also be used for DISPC fclk. Meaning, when the DPI output is
114 * disabled, DISPC clock will be disabled, and TV out will stop.
115 */
116 switch (omapdss_get_version()) {
117 case OMAPDSS_VER_OMAP24xx:
118 case OMAPDSS_VER_OMAP34xx_ES1:
119 case OMAPDSS_VER_OMAP34xx_ES3:
120 case OMAPDSS_VER_OMAP3630:
121 case OMAPDSS_VER_AM35xx:
Sathya Prakash M Rd6279d42014-03-24 16:31:51 +0530122 case OMAPDSS_VER_AM43xx:
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300123 return DSS_CLK_SRC_FCK;
Tomi Valkeinenbd0f5cc2012-12-13 14:21:30 +0200124
Tomi Valkeinenf8ad9842013-03-11 13:57:38 +0200125 case OMAPDSS_VER_OMAP4430_ES1:
126 case OMAPDSS_VER_OMAP4430_ES2:
127 case OMAPDSS_VER_OMAP4:
128 switch (channel) {
129 case OMAP_DSS_CHANNEL_LCD:
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300130 return DSS_CLK_SRC_PLL1_1;
Tomi Valkeinenf8ad9842013-03-11 13:57:38 +0200131 case OMAP_DSS_CHANNEL_LCD2:
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300132 return DSS_CLK_SRC_PLL2_1;
Tomi Valkeinenf8ad9842013-03-11 13:57:38 +0200133 default:
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300134 return DSS_CLK_SRC_FCK;
Tomi Valkeinenf8ad9842013-03-11 13:57:38 +0200135 }
136
137 case OMAPDSS_VER_OMAP5:
138 switch (channel) {
139 case OMAP_DSS_CHANNEL_LCD:
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300140 return DSS_CLK_SRC_PLL1_1;
Tomi Valkeinenf8ad9842013-03-11 13:57:38 +0200141 case OMAP_DSS_CHANNEL_LCD3:
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300142 return DSS_CLK_SRC_PLL2_1;
143 case OMAP_DSS_CHANNEL_LCD2:
Tomi Valkeinenf8ad9842013-03-11 13:57:38 +0200144 default:
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300145 return DSS_CLK_SRC_FCK;
Tomi Valkeinenf8ad9842013-03-11 13:57:38 +0200146 }
147
Tomi Valkeinena2408152014-12-31 11:26:06 +0200148 case OMAPDSS_VER_DRA7xx:
Tomi Valkeinen7bbdef22016-08-10 11:04:29 +0300149 return dpi_get_clk_src_dra7xx(channel);
Tomi Valkeinena2408152014-12-31 11:26:06 +0200150
Tomi Valkeinen0e8276e2012-10-22 16:12:58 +0300151 default:
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300152 return DSS_CLK_SRC_FCK;
Tomi Valkeinen0e8276e2012-10-22 16:12:58 +0300153 }
Archit Taneja7636b3b2011-04-12 13:52:26 +0530154}
155
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200156struct dpi_clk_calc_ctx {
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300157 struct dss_pll *pll;
Tomi Valkeinen13ece4d2016-05-17 16:20:07 +0300158 unsigned clkout_idx;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200159
160 /* inputs */
161
162 unsigned long pck_min, pck_max;
163
164 /* outputs */
165
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300166 struct dss_pll_clock_info pll_cinfo;
Tomi Valkeinenc56812f2014-01-28 08:50:47 +0200167 unsigned long fck;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200168 struct dispc_clock_info dispc_cinfo;
169};
170
171static bool dpi_calc_dispc_cb(int lckd, int pckd, unsigned long lck,
172 unsigned long pck, void *data)
173{
174 struct dpi_clk_calc_ctx *ctx = data;
175
176 /*
177 * Odd dividers give us uneven duty cycle, causing problem when level
178 * shifted. So skip all odd dividers when the pixel clock is on the
179 * higher side.
180 */
Tomi Valkeinen72e55122013-06-12 09:44:52 +0300181 if (ctx->pck_min >= 100000000) {
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200182 if (lckd > 1 && lckd % 2 != 0)
183 return false;
184
185 if (pckd > 1 && pckd % 2 != 0)
186 return false;
187 }
188
189 ctx->dispc_cinfo.lck_div = lckd;
190 ctx->dispc_cinfo.pck_div = pckd;
191 ctx->dispc_cinfo.lck = lck;
192 ctx->dispc_cinfo.pck = pck;
193
194 return true;
195}
196
197
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300198static bool dpi_calc_hsdiv_cb(int m_dispc, unsigned long dispc,
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200199 void *data)
200{
201 struct dpi_clk_calc_ctx *ctx = data;
202
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300203 ctx->pll_cinfo.mX[ctx->clkout_idx] = m_dispc;
204 ctx->pll_cinfo.clkout[ctx->clkout_idx] = dispc;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200205
206 return dispc_div_calc(dispc, ctx->pck_min, ctx->pck_max,
207 dpi_calc_dispc_cb, ctx);
208}
209
210
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300211static bool dpi_calc_pll_cb(int n, int m, unsigned long fint,
212 unsigned long clkdco,
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200213 void *data)
214{
215 struct dpi_clk_calc_ctx *ctx = data;
216
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300217 ctx->pll_cinfo.n = n;
218 ctx->pll_cinfo.m = m;
219 ctx->pll_cinfo.fint = fint;
220 ctx->pll_cinfo.clkdco = clkdco;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200221
Tomi Valkeinencd0715f2016-05-17 21:23:37 +0300222 return dss_pll_hsdiv_calc_a(ctx->pll, clkdco,
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300223 ctx->pck_min, dss_feat_get_param_max(FEAT_PARAM_DSS_FCK),
224 dpi_calc_hsdiv_cb, ctx);
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200225}
226
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200227static bool dpi_calc_dss_cb(unsigned long fck, void *data)
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200228{
229 struct dpi_clk_calc_ctx *ctx = data;
230
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200231 ctx->fck = fck;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200232
233 return dispc_div_calc(fck, ctx->pck_min, ctx->pck_max,
234 dpi_calc_dispc_cb, ctx);
235}
236
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300237static bool dpi_pll_clk_calc(struct dpi_data *dpi, unsigned long pck,
Archit Taneja630d2d02014-05-30 16:26:22 +0530238 struct dpi_clk_calc_ctx *ctx)
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200239{
240 unsigned long clkin;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200241
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200242 memset(ctx, 0, sizeof(*ctx));
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300243 ctx->pll = dpi->pll;
Tomi Valkeinen13ece4d2016-05-17 16:20:07 +0300244 ctx->clkout_idx = dss_pll_get_clkout_idx_for_src(dpi->clk_src);
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200245
Tomi Valkeinen683cd862016-05-18 12:06:49 +0300246 clkin = clk_get_rate(dpi->pll->clkin);
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200247
Tomi Valkeinen683cd862016-05-18 12:06:49 +0300248 if (dpi->pll->hw->type == DSS_PLL_TYPE_A) {
249 unsigned long pll_min, pll_max;
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300250
Tomi Valkeinen683cd862016-05-18 12:06:49 +0300251 ctx->pck_min = pck - 1000;
252 ctx->pck_max = pck + 1000;
253
254 pll_min = 0;
255 pll_max = 0;
256
257 return dss_pll_calc_a(ctx->pll, clkin,
258 pll_min, pll_max,
259 dpi_calc_pll_cb, ctx);
260 } else { /* DSS_PLL_TYPE_B */
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300261 dss_pll_calc_b(dpi->pll, clkin, pck, &ctx->pll_cinfo);
Tomi Valkeinen683cd862016-05-18 12:06:49 +0300262
263 ctx->dispc_cinfo.lck_div = 1;
264 ctx->dispc_cinfo.pck_div = 1;
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300265 ctx->dispc_cinfo.lck = ctx->pll_cinfo.clkout[0];
Tomi Valkeinen683cd862016-05-18 12:06:49 +0300266 ctx->dispc_cinfo.pck = ctx->dispc_cinfo.lck;
267
268 return true;
269 }
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200270}
271
272static bool dpi_dss_clk_calc(unsigned long pck, struct dpi_clk_calc_ctx *ctx)
273{
274 int i;
275
276 /*
277 * DSS fck gives us very few possibilities, so finding a good pixel
278 * clock may not be possible. We try multiple times to find the clock,
279 * each time widening the pixel clock range we look for, up to
Tomi Valkeinen2c6360f2013-04-10 14:54:54 +0300280 * +/- ~15MHz.
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200281 */
282
Tomi Valkeinen2c6360f2013-04-10 14:54:54 +0300283 for (i = 0; i < 25; ++i) {
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200284 bool ok;
285
286 memset(ctx, 0, sizeof(*ctx));
287 if (pck > 1000 * i * i * i)
288 ctx->pck_min = max(pck - 1000 * i * i * i, 0lu);
289 else
290 ctx->pck_min = 0;
291 ctx->pck_max = pck + 1000 * i * i * i;
292
Tomi Valkeinen688af022013-10-31 16:41:57 +0200293 ok = dss_div_calc(pck, ctx->pck_min, dpi_calc_dss_cb, ctx);
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200294 if (ok)
295 return ok;
296 }
297
298 return false;
299}
300
301
302
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300303static int dpi_set_pll_clk(struct dpi_data *dpi, enum omap_channel channel,
Sumit Semwalff1b2cde2010-12-02 11:27:11 +0000304 unsigned long pck_req, unsigned long *fck, int *lck_div,
305 int *pck_div)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300306{
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200307 struct dpi_clk_calc_ctx ctx;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300308 int r;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200309 bool ok;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300310
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300311 ok = dpi_pll_clk_calc(dpi, pck_req, &ctx);
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200312 if (!ok)
313 return -EINVAL;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300314
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300315 r = dss_pll_set_config(dpi->pll, &ctx.pll_cinfo);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300316 if (r)
317 return r;
318
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300319 dss_select_lcd_clk_source(channel, dpi->clk_src);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300320
Archit Taneja630d2d02014-05-30 16:26:22 +0530321 dpi->mgr_config.clock_info = ctx.dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300322
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300323 *fck = ctx.pll_cinfo.clkout[ctx.clkout_idx];
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200324 *lck_div = ctx.dispc_cinfo.lck_div;
325 *pck_div = ctx.dispc_cinfo.pck_div;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300326
327 return 0;
328}
Archit Taneja7636b3b2011-04-12 13:52:26 +0530329
Archit Taneja630d2d02014-05-30 16:26:22 +0530330static int dpi_set_dispc_clk(struct dpi_data *dpi, unsigned long pck_req,
331 unsigned long *fck, int *lck_div, int *pck_div)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300332{
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200333 struct dpi_clk_calc_ctx ctx;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300334 int r;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200335 bool ok;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300336
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200337 ok = dpi_dss_clk_calc(pck_req, &ctx);
338 if (!ok)
339 return -EINVAL;
340
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200341 r = dss_set_fck_rate(ctx.fck);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300342 if (r)
343 return r;
344
Archit Taneja630d2d02014-05-30 16:26:22 +0530345 dpi->mgr_config.clock_info = ctx.dispc_cinfo;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300346
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200347 *fck = ctx.fck;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200348 *lck_div = ctx.dispc_cinfo.lck_div;
349 *pck_div = ctx.dispc_cinfo.pck_div;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300350
351 return 0;
352}
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300353
Archit Taneja630d2d02014-05-30 16:26:22 +0530354static int dpi_set_mode(struct dpi_data *dpi)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300355{
Archit Taneja630d2d02014-05-30 16:26:22 +0530356 struct omap_dss_device *out = &dpi->output;
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200357 enum omap_channel channel = out->dispc_channel;
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300358 struct videomode *vm = &dpi->vm;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530359 int lck_div = 0, pck_div = 0;
360 unsigned long fck = 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300361 unsigned long pck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300362 int r = 0;
363
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300364 if (dpi->pll)
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300365 r = dpi_set_pll_clk(dpi, channel, vm->pixelclock, &fck,
Archit Taneja6d523e72012-06-21 09:33:55 +0530366 &lck_div, &pck_div);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530367 else
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300368 r = dpi_set_dispc_clk(dpi, vm->pixelclock, &fck,
Archit Taneja6d523e72012-06-21 09:33:55 +0530369 &lck_div, &pck_div);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300370 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300371 return r;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300372
Tomi Valkeinend8d789412013-04-10 14:12:14 +0300373 pck = fck / lck_div / pck_div;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300374
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300375 if (pck != vm->pixelclock) {
Peter Ujfalusi7aa91e72016-09-22 14:07:02 +0300376 DSSWARN("Could not find exact pixel clock. Requested %lu Hz, got %lu Hz\n",
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300377 vm->pixelclock, pck);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300378
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300379 vm->pixelclock = pck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300380 }
381
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300382 dss_mgr_set_timings(channel, vm);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300383
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300384 return 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300385}
386
Archit Taneja630d2d02014-05-30 16:26:22 +0530387static void dpi_config_lcd_manager(struct dpi_data *dpi)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300388{
Archit Taneja630d2d02014-05-30 16:26:22 +0530389 struct omap_dss_device *out = &dpi->output;
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200390 enum omap_channel channel = out->dispc_channel;
Archit Taneja569969d2011-08-22 17:41:57 +0530391
Archit Taneja630d2d02014-05-30 16:26:22 +0530392 dpi->mgr_config.io_pad_mode = DSS_IO_PAD_MODE_BYPASS;
Archit Taneja5cf9a262012-06-29 14:19:13 +0530393
Archit Taneja630d2d02014-05-30 16:26:22 +0530394 dpi->mgr_config.stallmode = false;
395 dpi->mgr_config.fifohandcheck = false;
Archit Taneja5cf9a262012-06-29 14:19:13 +0530396
Archit Taneja630d2d02014-05-30 16:26:22 +0530397 dpi->mgr_config.video_port_width = dpi->data_lines;
Archit Taneja5cf9a262012-06-29 14:19:13 +0530398
Archit Taneja630d2d02014-05-30 16:26:22 +0530399 dpi->mgr_config.lcden_sig_polarity = 0;
400
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200401 dss_mgr_set_lcd_config(channel, &dpi->mgr_config);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300402}
403
Tomi Valkeinen86a3efe2013-05-15 10:40:15 +0300404static int dpi_display_enable(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300405{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530406 struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);
Archit Taneja630d2d02014-05-30 16:26:22 +0530407 struct omap_dss_device *out = &dpi->output;
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200408 enum omap_channel channel = out->dispc_channel;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300409 int r;
410
Archit Taneja630d2d02014-05-30 16:26:22 +0530411 mutex_lock(&dpi->lock);
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530412
Archit Taneja630d2d02014-05-30 16:26:22 +0530413 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI) && !dpi->vdds_dsi_reg) {
Russell King40410712012-02-07 09:44:55 +0000414 DSSERR("no VDSS_DSI regulator\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530415 r = -ENODEV;
416 goto err_no_reg;
Russell King40410712012-02-07 09:44:55 +0000417 }
418
Tomi Valkeinenf1504ad2015-11-05 09:34:51 +0200419 if (!out->dispc_channel_connected) {
Archit Taneja5d512fc2012-09-07 17:53:38 +0530420 DSSERR("failed to enable display: no output/manager\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530421 r = -ENODEV;
Archit Taneja5d512fc2012-09-07 17:53:38 +0530422 goto err_no_out_mgr;
Tomi Valkeinen05e1d602011-06-23 16:38:21 +0300423 }
424
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530425 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) {
Archit Taneja630d2d02014-05-30 16:26:22 +0530426 r = regulator_enable(dpi->vdds_dsi_reg);
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200427 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300428 goto err_reg_enable;
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200429 }
430
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300431 r = dispc_runtime_get();
432 if (r)
433 goto err_get_dispc;
434
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200435 r = dss_dpi_select_source(out->port_num, channel);
Tomi Valkeinende09e452012-09-21 12:09:54 +0300436 if (r)
437 goto err_src_sel;
438
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300439 if (dpi->pll) {
440 r = dss_pll_enable(dpi->pll);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530441 if (r)
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300442 goto err_pll_init;
Archit Taneja7636b3b2011-04-12 13:52:26 +0530443 }
444
Archit Taneja630d2d02014-05-30 16:26:22 +0530445 r = dpi_set_mode(dpi);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300446 if (r)
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300447 goto err_set_mode;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300448
Archit Taneja630d2d02014-05-30 16:26:22 +0530449 dpi_config_lcd_manager(dpi);
Archit Taneja5cf9a262012-06-29 14:19:13 +0530450
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300451 mdelay(2);
452
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200453 r = dss_mgr_enable(channel);
Tomi Valkeinen33ca2372011-11-21 13:42:58 +0200454 if (r)
455 goto err_mgr_enable;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300456
Archit Taneja630d2d02014-05-30 16:26:22 +0530457 mutex_unlock(&dpi->lock);
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530458
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300459 return 0;
460
Tomi Valkeinen33ca2372011-11-21 13:42:58 +0200461err_mgr_enable:
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300462err_set_mode:
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300463 if (dpi->pll)
464 dss_pll_disable(dpi->pll);
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300465err_pll_init:
Tomi Valkeinende09e452012-09-21 12:09:54 +0300466err_src_sel:
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300467 dispc_runtime_put();
468err_get_dispc:
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530469 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI))
Archit Taneja630d2d02014-05-30 16:26:22 +0530470 regulator_disable(dpi->vdds_dsi_reg);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300471err_reg_enable:
Archit Taneja5d512fc2012-09-07 17:53:38 +0530472err_no_out_mgr:
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530473err_no_reg:
Archit Taneja630d2d02014-05-30 16:26:22 +0530474 mutex_unlock(&dpi->lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300475 return r;
476}
477
Tomi Valkeinen86a3efe2013-05-15 10:40:15 +0300478static void dpi_display_disable(struct omap_dss_device *dssdev)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300479{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530480 struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200481 enum omap_channel channel = dpi->output.dispc_channel;
Archit Taneja5d512fc2012-09-07 17:53:38 +0530482
Archit Taneja630d2d02014-05-30 16:26:22 +0530483 mutex_lock(&dpi->lock);
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530484
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200485 dss_mgr_disable(channel);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300486
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300487 if (dpi->pll) {
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300488 dss_select_lcd_clk_source(channel, DSS_CLK_SRC_FCK);
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300489 dss_pll_disable(dpi->pll);
Archit Taneja7636b3b2011-04-12 13:52:26 +0530490 }
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300491
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300492 dispc_runtime_put();
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300493
Chandrabhanu Mahapatra195e6722012-08-22 11:44:06 +0530494 if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI))
Archit Taneja630d2d02014-05-30 16:26:22 +0530495 regulator_disable(dpi->vdds_dsi_reg);
Tomi Valkeinen8a2cfea2010-02-04 17:03:41 +0200496
Archit Taneja630d2d02014-05-30 16:26:22 +0530497 mutex_unlock(&dpi->lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300498}
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300499
Tomi Valkeinen86a3efe2013-05-15 10:40:15 +0300500static void dpi_set_timings(struct omap_dss_device *dssdev,
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300501 struct videomode *vm)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300502{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530503 struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);
Archit Taneja630d2d02014-05-30 16:26:22 +0530504
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300505 DSSDBG("dpi_set_timings\n");
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530506
Archit Taneja630d2d02014-05-30 16:26:22 +0530507 mutex_lock(&dpi->lock);
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530508
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300509 dpi->vm = *vm;
Archit Tanejac4991442012-08-08 14:28:54 +0530510
Archit Taneja630d2d02014-05-30 16:26:22 +0530511 mutex_unlock(&dpi->lock);
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300512}
513
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300514static void dpi_get_timings(struct omap_dss_device *dssdev,
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300515 struct videomode *vm)
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300516{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530517 struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300518
Archit Taneja630d2d02014-05-30 16:26:22 +0530519 mutex_lock(&dpi->lock);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300520
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300521 *vm = dpi->vm;
Archit Taneja630d2d02014-05-30 16:26:22 +0530522
523 mutex_unlock(&dpi->lock);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300524}
525
Tomi Valkeinen86a3efe2013-05-15 10:40:15 +0300526static int dpi_check_timings(struct omap_dss_device *dssdev,
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300527 struct videomode *vm)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300528{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530529 struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200530 enum omap_channel channel = dpi->output.dispc_channel;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300531 int lck_div, pck_div;
532 unsigned long fck;
533 unsigned long pck;
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200534 struct dpi_clk_calc_ctx ctx;
535 bool ok;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300536
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300537 if (vm->hactive % 8 != 0)
Tomi Valkeinen2158f2c2016-01-05 11:43:18 +0200538 return -EINVAL;
539
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300540 if (!dispc_mgr_timings_ok(channel, vm))
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300541 return -EINVAL;
542
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300543 if (vm->pixelclock == 0)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300544 return -EINVAL;
545
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300546 if (dpi->pll) {
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300547 ok = dpi_pll_clk_calc(dpi, vm->pixelclock, &ctx);
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200548 if (!ok)
549 return -EINVAL;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300550
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300551 fck = ctx.pll_cinfo.clkout[ctx.clkout_idx];
Archit Taneja7636b3b2011-04-12 13:52:26 +0530552 } else {
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300553 ok = dpi_dss_clk_calc(vm->pixelclock, &ctx);
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200554 if (!ok)
555 return -EINVAL;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300556
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200557 fck = ctx.fck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300558 }
Archit Taneja7636b3b2011-04-12 13:52:26 +0530559
Tomi Valkeinen100c8262013-03-05 17:07:16 +0200560 lck_div = ctx.dispc_cinfo.lck_div;
561 pck_div = ctx.dispc_cinfo.pck_div;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300562
Tomi Valkeinend8d789412013-04-10 14:12:14 +0300563 pck = fck / lck_div / pck_div;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300564
Peter Ujfalusida11bbbb2016-09-22 14:07:04 +0300565 vm->pixelclock = pck;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300566
567 return 0;
568}
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300569
Tomi Valkeinen86a3efe2013-05-15 10:40:15 +0300570static void dpi_set_data_lines(struct omap_dss_device *dssdev, int data_lines)
Archit Tanejac6b393d2012-07-06 15:30:52 +0530571{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530572 struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);
Archit Tanejac6b393d2012-07-06 15:30:52 +0530573
Archit Taneja630d2d02014-05-30 16:26:22 +0530574 mutex_lock(&dpi->lock);
Archit Tanejac6b393d2012-07-06 15:30:52 +0530575
Archit Taneja630d2d02014-05-30 16:26:22 +0530576 dpi->data_lines = data_lines;
577
578 mutex_unlock(&dpi->lock);
Archit Tanejac6b393d2012-07-06 15:30:52 +0530579}
Archit Tanejac6b393d2012-07-06 15:30:52 +0530580
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300581static int dpi_verify_pll(struct dss_pll *pll)
Tomi Valkeinen60616752012-10-30 12:57:43 +0200582{
583 int r;
584
585 /* do initial setup with the PLL to see if it is operational */
586
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300587 r = dss_pll_enable(pll);
Tomi Valkeinen60616752012-10-30 12:57:43 +0200588 if (r)
589 return r;
590
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300591 dss_pll_disable(pll);
Tomi Valkeinen60616752012-10-30 12:57:43 +0200592
593 return 0;
594}
595
Archit Taneja630d2d02014-05-30 16:26:22 +0530596static int dpi_init_regulator(struct dpi_data *dpi)
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300597{
598 struct regulator *vdds_dsi;
599
600 if (!dss_has_feature(FEAT_DPI_USES_VDDS_DSI))
601 return 0;
602
Archit Taneja630d2d02014-05-30 16:26:22 +0530603 if (dpi->vdds_dsi_reg)
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300604 return 0;
605
Archit Taneja630d2d02014-05-30 16:26:22 +0530606 vdds_dsi = devm_regulator_get(&dpi->pdev->dev, "vdds_dsi");
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300607 if (IS_ERR(vdds_dsi)) {
Tomi Valkeinen40359a92013-12-19 16:15:34 +0200608 if (PTR_ERR(vdds_dsi) != -EPROBE_DEFER)
609 DSSERR("can't get VDDS_DSI regulator\n");
Tomi Valkeinen4123de22013-08-29 10:06:55 +0300610 return PTR_ERR(vdds_dsi);
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300611 }
612
Archit Taneja630d2d02014-05-30 16:26:22 +0530613 dpi->vdds_dsi_reg = vdds_dsi;
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300614
615 return 0;
616}
617
Archit Taneja630d2d02014-05-30 16:26:22 +0530618static void dpi_init_pll(struct dpi_data *dpi)
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300619{
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300620 struct dss_pll *pll;
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300621
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300622 if (dpi->pll)
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300623 return;
624
Tomi Valkeinen331e6072016-05-17 16:08:54 +0300625 dpi->clk_src = dpi_get_clk_src(dpi->output.dispc_channel);
626
627 pll = dss_pll_find_by_src(dpi->clk_src);
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300628 if (!pll)
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300629 return;
630
Tomi Valkeinen31dca072016-05-18 12:22:32 +0300631 if (dpi_verify_pll(pll)) {
632 DSSWARN("PLL not operational\n");
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300633 return;
634 }
635
Tomi Valkeinen2daea7a2014-10-22 14:49:14 +0300636 dpi->pll = pll;
Tomi Valkeinen2795f642013-04-19 16:52:27 +0300637}
638
Tomi Valkeinen2eea5ae2013-02-13 11:23:54 +0200639/*
640 * Return a hardcoded channel for the DPI output. This should work for
641 * current use cases, but this can be later expanded to either resolve
642 * the channel in some more dynamic manner, or get the channel as a user
643 * parameter.
644 */
Archit Tanejaf7e38fe2014-05-06 17:07:39 +0530645static enum omap_channel dpi_get_channel(int port_num)
Tomi Valkeinen2eea5ae2013-02-13 11:23:54 +0200646{
647 switch (omapdss_get_version()) {
648 case OMAPDSS_VER_OMAP24xx:
649 case OMAPDSS_VER_OMAP34xx_ES1:
650 case OMAPDSS_VER_OMAP34xx_ES3:
651 case OMAPDSS_VER_OMAP3630:
652 case OMAPDSS_VER_AM35xx:
Sathya Prakash M Rd6279d42014-03-24 16:31:51 +0530653 case OMAPDSS_VER_AM43xx:
Tomi Valkeinen2eea5ae2013-02-13 11:23:54 +0200654 return OMAP_DSS_CHANNEL_LCD;
655
Tomi Valkeinena2408152014-12-31 11:26:06 +0200656 case OMAPDSS_VER_DRA7xx:
657 switch (port_num) {
658 case 2:
659 return OMAP_DSS_CHANNEL_LCD3;
660 case 1:
661 return OMAP_DSS_CHANNEL_LCD2;
662 case 0:
663 default:
664 return OMAP_DSS_CHANNEL_LCD;
665 }
666
Tomi Valkeinen2eea5ae2013-02-13 11:23:54 +0200667 case OMAPDSS_VER_OMAP4430_ES1:
668 case OMAPDSS_VER_OMAP4430_ES2:
669 case OMAPDSS_VER_OMAP4:
670 return OMAP_DSS_CHANNEL_LCD2;
671
672 case OMAPDSS_VER_OMAP5:
673 return OMAP_DSS_CHANNEL_LCD3;
674
675 default:
676 DSSWARN("unsupported DSS version\n");
677 return OMAP_DSS_CHANNEL_LCD;
678 }
679}
680
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300681static int dpi_connect(struct omap_dss_device *dssdev,
682 struct omap_dss_device *dst)
683{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530684 struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200685 enum omap_channel channel = dpi->output.dispc_channel;
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300686 int r;
687
Archit Taneja630d2d02014-05-30 16:26:22 +0530688 r = dpi_init_regulator(dpi);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300689 if (r)
690 return r;
691
Archit Taneja630d2d02014-05-30 16:26:22 +0530692 dpi_init_pll(dpi);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300693
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200694 r = dss_mgr_connect(channel, dssdev);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300695 if (r)
696 return r;
697
698 r = omapdss_output_set_device(dssdev, dst);
699 if (r) {
700 DSSERR("failed to connect output to new device: %s\n",
701 dst->name);
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200702 dss_mgr_disconnect(channel, dssdev);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300703 return r;
704 }
705
706 return 0;
707}
708
709static void dpi_disconnect(struct omap_dss_device *dssdev,
710 struct omap_dss_device *dst)
711{
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200712 struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);
713 enum omap_channel channel = dpi->output.dispc_channel;
714
Tomi Valkeinen9560dc102013-07-24 13:06:54 +0300715 WARN_ON(dst != dssdev->dst);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300716
Tomi Valkeinen9560dc102013-07-24 13:06:54 +0300717 if (dst != dssdev->dst)
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300718 return;
719
720 omapdss_output_unset_device(dssdev);
721
Tomi Valkeinena070ba62015-11-05 09:52:00 +0200722 dss_mgr_disconnect(channel, dssdev);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300723}
724
725static const struct omapdss_dpi_ops dpi_ops = {
726 .connect = dpi_connect,
727 .disconnect = dpi_disconnect,
728
Tomi Valkeinen86a3efe2013-05-15 10:40:15 +0300729 .enable = dpi_display_enable,
730 .disable = dpi_display_disable,
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300731
732 .check_timings = dpi_check_timings,
Tomi Valkeinen86a3efe2013-05-15 10:40:15 +0300733 .set_timings = dpi_set_timings,
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300734 .get_timings = dpi_get_timings,
735
Tomi Valkeinen86a3efe2013-05-15 10:40:15 +0300736 .set_data_lines = dpi_set_data_lines,
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300737};
738
Tomi Valkeinen94cf3942013-04-26 14:27:44 +0300739static void dpi_init_output(struct platform_device *pdev)
Archit Taneja81b87f52012-09-26 16:30:49 +0530740{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530741 struct dpi_data *dpi = dpi_get_data_from_pdev(pdev);
Archit Taneja630d2d02014-05-30 16:26:22 +0530742 struct omap_dss_device *out = &dpi->output;
Archit Taneja81b87f52012-09-26 16:30:49 +0530743
Tomi Valkeinen1f68d9c2013-04-19 15:09:34 +0300744 out->dev = &pdev->dev;
Archit Taneja81b87f52012-09-26 16:30:49 +0530745 out->id = OMAP_DSS_OUTPUT_DPI;
Tomi Valkeinen1f68d9c2013-04-19 15:09:34 +0300746 out->output_type = OMAP_DISPLAY_TYPE_DPI;
Tomi Valkeinen7286a082013-02-18 13:06:01 +0200747 out->name = "dpi.0";
Archit Tanejaf7e38fe2014-05-06 17:07:39 +0530748 out->dispc_channel = dpi_get_channel(0);
Tomi Valkeinen0b24edb2013-05-24 13:18:52 +0300749 out->ops.dpi = &dpi_ops;
Tomi Valkeinenb7328e12013-05-03 11:42:18 +0300750 out->owner = THIS_MODULE;
Archit Taneja81b87f52012-09-26 16:30:49 +0530751
Tomi Valkeinen5d47dbc2013-04-24 13:32:51 +0300752 omapdss_register_output(out);
Archit Taneja81b87f52012-09-26 16:30:49 +0530753}
754
Tomi Valkeinenede92692015-06-04 14:12:16 +0300755static void dpi_uninit_output(struct platform_device *pdev)
Archit Taneja81b87f52012-09-26 16:30:49 +0530756{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530757 struct dpi_data *dpi = dpi_get_data_from_pdev(pdev);
Archit Taneja630d2d02014-05-30 16:26:22 +0530758 struct omap_dss_device *out = &dpi->output;
Archit Taneja81b87f52012-09-26 16:30:49 +0530759
Tomi Valkeinen5d47dbc2013-04-24 13:32:51 +0300760 omapdss_unregister_output(out);
Archit Taneja81b87f52012-09-26 16:30:49 +0530761}
762
Archit Taneja80eb6752014-06-02 14:11:51 +0530763static void dpi_init_output_port(struct platform_device *pdev,
764 struct device_node *port)
765{
766 struct dpi_data *dpi = port->data;
767 struct omap_dss_device *out = &dpi->output;
Archit Tanejaf7e38fe2014-05-06 17:07:39 +0530768 int r;
769 u32 port_num;
770
771 r = of_property_read_u32(port, "reg", &port_num);
772 if (r)
773 port_num = 0;
774
775 switch (port_num) {
776 case 2:
777 out->name = "dpi.2";
778 break;
779 case 1:
780 out->name = "dpi.1";
781 break;
782 case 0:
783 default:
784 out->name = "dpi.0";
785 break;
786 }
Archit Taneja80eb6752014-06-02 14:11:51 +0530787
788 out->dev = &pdev->dev;
789 out->id = OMAP_DSS_OUTPUT_DPI;
790 out->output_type = OMAP_DISPLAY_TYPE_DPI;
Archit Tanejaf7e38fe2014-05-06 17:07:39 +0530791 out->dispc_channel = dpi_get_channel(port_num);
792 out->port_num = port_num;
Archit Taneja80eb6752014-06-02 14:11:51 +0530793 out->ops.dpi = &dpi_ops;
794 out->owner = THIS_MODULE;
795
796 omapdss_register_output(out);
797}
798
Tomi Valkeinenede92692015-06-04 14:12:16 +0300799static void dpi_uninit_output_port(struct device_node *port)
Archit Taneja80eb6752014-06-02 14:11:51 +0530800{
801 struct dpi_data *dpi = port->data;
802 struct omap_dss_device *out = &dpi->output;
803
804 omapdss_unregister_output(out);
805}
806
Tomi Valkeinen736e60d2015-06-04 15:22:23 +0300807static int dpi_bind(struct device *dev, struct device *master, void *data)
Tomi Valkeinen38f3daf2012-05-02 14:55:12 +0300808{
Tomi Valkeinen736e60d2015-06-04 15:22:23 +0300809 struct platform_device *pdev = to_platform_device(dev);
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530810 struct dpi_data *dpi;
811
812 dpi = devm_kzalloc(&pdev->dev, sizeof(*dpi), GFP_KERNEL);
813 if (!dpi)
814 return -ENOMEM;
Tomi Valkeinen00df43b2013-03-19 11:33:52 +0200815
Archit Taneja630d2d02014-05-30 16:26:22 +0530816 dpi->pdev = pdev;
817
818 dev_set_drvdata(&pdev->dev, dpi);
819
820 mutex_init(&dpi->lock);
Archit Tanejac8a5e4e2012-07-05 12:52:46 +0530821
Archit Taneja81b87f52012-09-26 16:30:49 +0530822 dpi_init_output(pdev);
823
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300824 return 0;
825}
826
Tomi Valkeinen736e60d2015-06-04 15:22:23 +0300827static void dpi_unbind(struct device *dev, struct device *master, void *data)
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300828{
Tomi Valkeinen736e60d2015-06-04 15:22:23 +0300829 struct platform_device *pdev = to_platform_device(dev);
Archit Taneja81b87f52012-09-26 16:30:49 +0530830
Tomi Valkeinen736e60d2015-06-04 15:22:23 +0300831 dpi_uninit_output(pdev);
832}
833
834static const struct component_ops dpi_component_ops = {
835 .bind = dpi_bind,
836 .unbind = dpi_unbind,
837};
838
839static int dpi_probe(struct platform_device *pdev)
840{
841 return component_add(&pdev->dev, &dpi_component_ops);
842}
843
844static int dpi_remove(struct platform_device *pdev)
845{
846 component_del(&pdev->dev, &dpi_component_ops);
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200847 return 0;
Tomi Valkeinen553c48c2009-08-07 13:15:50 +0300848}
849
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200850static struct platform_driver omap_dpi_driver = {
Tomi Valkeinen736e60d2015-06-04 15:22:23 +0300851 .probe = dpi_probe,
852 .remove = dpi_remove,
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200853 .driver = {
854 .name = "omapdss_dpi",
Tomi Valkeinen422ccbd2014-10-16 09:54:25 +0300855 .suppress_bind_attrs = true,
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200856 },
857};
858
Tomi Valkeinen6e7e8f02012-02-17 17:41:13 +0200859int __init dpi_init_platform_driver(void)
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200860{
Tomi Valkeinen94cf3942013-04-26 14:27:44 +0300861 return platform_driver_register(&omap_dpi_driver);
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200862}
863
Tomi Valkeinenede92692015-06-04 14:12:16 +0300864void dpi_uninit_platform_driver(void)
Tomi Valkeinena57dd4f2012-02-20 16:57:37 +0200865{
866 platform_driver_unregister(&omap_dpi_driver);
867}
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200868
Tomi Valkeinenede92692015-06-04 14:12:16 +0300869int dpi_init_port(struct platform_device *pdev, struct device_node *port)
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200870{
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530871 struct dpi_data *dpi;
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200872 struct device_node *ep;
873 u32 datalines;
874 int r;
875
Archit Taneja2ac6a1a2014-06-01 12:47:44 +0530876 dpi = devm_kzalloc(&pdev->dev, sizeof(*dpi), GFP_KERNEL);
877 if (!dpi)
878 return -ENOMEM;
879
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200880 ep = omapdss_of_get_next_endpoint(port, NULL);
881 if (!ep)
882 return 0;
883
884 r = of_property_read_u32(ep, "data-lines", &datalines);
885 if (r) {
886 DSSERR("failed to parse datalines\n");
887 goto err_datalines;
888 }
889
Archit Taneja630d2d02014-05-30 16:26:22 +0530890 dpi->data_lines = datalines;
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200891
892 of_node_put(ep);
893
Archit Taneja630d2d02014-05-30 16:26:22 +0530894 dpi->pdev = pdev;
Archit Taneja80eb6752014-06-02 14:11:51 +0530895 port->data = dpi;
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200896
Archit Taneja630d2d02014-05-30 16:26:22 +0530897 mutex_init(&dpi->lock);
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200898
Archit Taneja80eb6752014-06-02 14:11:51 +0530899 dpi_init_output_port(pdev, port);
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200900
Archit Taneja630d2d02014-05-30 16:26:22 +0530901 dpi->port_initialized = true;
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200902
903 return 0;
904
905err_datalines:
906 of_node_put(ep);
907
908 return r;
909}
910
Tomi Valkeinenede92692015-06-04 14:12:16 +0300911void dpi_uninit_port(struct device_node *port)
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200912{
Archit Taneja80eb6752014-06-02 14:11:51 +0530913 struct dpi_data *dpi = port->data;
Archit Taneja630d2d02014-05-30 16:26:22 +0530914
915 if (!dpi->port_initialized)
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200916 return;
917
Archit Taneja80eb6752014-06-02 14:11:51 +0530918 dpi_uninit_output_port(port);
Tomi Valkeinen2ecef242013-12-16 15:13:24 +0200919}