blob: 4b00faa1a8cce700c6248e8b23e7c9cd010cb850 [file] [log] [blame]
Tomi Valkeinen559d6702009-11-03 11:23:50 +02001/*
Tomi Valkeinen559d6702009-11-03 11:23:50 +02002 * Copyright (C) 2009 Nokia Corporation
3 * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
4 *
5 * Some code and ideas taken from drivers/video/omap/ driver
6 * by Imre Deak.
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License version 2 as published by
10 * the Free Software Foundation.
11 *
12 * This program is distributed in the hope that it will be useful, but WITHOUT
13 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
14 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
15 * more details.
16 *
17 * You should have received a copy of the GNU General Public License along with
18 * this program. If not, see <http://www.gnu.org/licenses/>.
19 */
20
21#define DSS_SUBSYS_NAME "DSS"
22
Laurent Pinchart11765d12017-08-05 01:44:01 +030023#include <linux/debugfs.h>
Laurent Pincharta921c1a2017-10-13 17:59:01 +030024#include <linux/dma-mapping.h>
Tomi Valkeinen559d6702009-11-03 11:23:50 +020025#include <linux/kernel.h>
Tomi Valkeinen2ecef242013-12-16 15:13:24 +020026#include <linux/module.h>
Tomi Valkeinen559d6702009-11-03 11:23:50 +020027#include <linux/io.h>
Paul Gortmakera8a35932011-07-10 13:20:26 -040028#include <linux/export.h>
Tomi Valkeinen559d6702009-11-03 11:23:50 +020029#include <linux/err.h>
30#include <linux/delay.h>
Tomi Valkeinen559d6702009-11-03 11:23:50 +020031#include <linux/seq_file.h>
32#include <linux/clk.h>
Arnd Bergmann2639d6b2016-05-09 23:51:27 +020033#include <linux/pinctrl/consumer.h>
Tomi Valkeinen24e62892011-05-23 11:51:18 +030034#include <linux/platform_device.h>
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +030035#include <linux/pm_runtime.h>
Chandrabhanu Mahapatra185bae12012-07-11 18:36:18 +053036#include <linux/gfp.h>
Tomi Valkeinen33366d02012-09-28 13:54:35 +030037#include <linux/sizes.h>
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +053038#include <linux/mfd/syscon.h>
39#include <linux/regmap.h>
Tomi Valkeinen2ecef242013-12-16 15:13:24 +020040#include <linux/of.h>
Laurent Pinchart18daeb82017-08-05 01:43:58 +030041#include <linux/of_device.h>
Rob Herring09bffa62017-03-22 08:26:08 -050042#include <linux/of_graph.h>
Tomi Valkeinen99767542014-07-04 13:38:27 +053043#include <linux/regulator/consumer.h>
Tomi Valkeinencb17a4a2015-02-25 12:08:14 +020044#include <linux/suspend.h>
Tomi Valkeinen736e60d2015-06-04 15:22:23 +030045#include <linux/component.h>
Laurent Pinchart18daeb82017-08-05 01:43:58 +030046#include <linux/sys_soc.h>
Tomi Valkeinen559d6702009-11-03 11:23:50 +020047
Peter Ujfalusi32043da2016-05-27 14:40:49 +030048#include "omapdss.h"
Tomi Valkeinen559d6702009-11-03 11:23:50 +020049#include "dss.h"
50
Tomi Valkeinen559d6702009-11-03 11:23:50 +020051struct dss_reg {
52 u16 idx;
53};
54
55#define DSS_REG(idx) ((const struct dss_reg) { idx })
56
57#define DSS_REVISION DSS_REG(0x0000)
58#define DSS_SYSCONFIG DSS_REG(0x0010)
59#define DSS_SYSSTATUS DSS_REG(0x0014)
Tomi Valkeinen559d6702009-11-03 11:23:50 +020060#define DSS_CONTROL DSS_REG(0x0040)
61#define DSS_SDI_CONTROL DSS_REG(0x0044)
62#define DSS_PLL_CONTROL DSS_REG(0x0048)
63#define DSS_SDI_STATUS DSS_REG(0x005C)
64
Laurent Pinchart360c2152018-02-13 14:00:28 +020065#define REG_GET(dss, idx, start, end) \
66 FLD_GET(dss_read_reg(dss, idx), start, end)
Tomi Valkeinen559d6702009-11-03 11:23:50 +020067
Laurent Pinchart360c2152018-02-13 14:00:28 +020068#define REG_FLD_MOD(dss, idx, val, start, end) \
69 dss_write_reg(dss, idx, \
70 FLD_MOD(dss_read_reg(dss, idx), val, start, end))
Tomi Valkeinen559d6702009-11-03 11:23:50 +020071
Laurent Pinchartfecea252017-08-05 01:43:52 +030072struct dss_ops {
Laurent Pinchart8aea8e62018-02-13 14:00:24 +020073 int (*dpi_select_source)(struct dss_device *dss, int port,
74 enum omap_channel channel);
75 int (*select_lcd_source)(struct dss_device *dss,
76 enum omap_channel channel,
77 enum dss_clk_source clk_src);
Laurent Pinchartfecea252017-08-05 01:43:52 +030078};
79
Chandrabhanu Mahapatra185bae12012-07-11 18:36:18 +053080struct dss_features {
Laurent Pinchartb8dab2b2017-08-05 01:43:56 +030081 enum dss_model model;
Chandrabhanu Mahapatra185bae12012-07-11 18:36:18 +053082 u8 fck_div_max;
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +030083 unsigned int fck_freq_max;
Chandrabhanu Mahapatra185bae12012-07-11 18:36:18 +053084 u8 dss_fck_multiplier;
Tomi Valkeinen64ad8462013-11-01 11:38:04 +020085 const char *parent_clk_name;
Tomi Valkeinen234f9a22014-12-11 15:59:31 +020086 const enum omap_display_type *ports;
Archit Taneja387ce9f2014-05-22 17:01:57 +053087 int num_ports;
Laurent Pinchart51919572017-08-05 01:44:18 +030088 const enum omap_dss_output_id *outputs;
Laurent Pinchartfecea252017-08-05 01:43:52 +030089 const struct dss_ops *ops;
Laurent Pinchart6d85d4a2017-08-05 01:44:07 +030090 struct dss_reg_field dispc_clk_switch;
Laurent Pinchart4569ab72017-08-05 01:44:13 +030091 bool has_lcd_clk_src;
Chandrabhanu Mahapatra185bae12012-07-11 18:36:18 +053092};
93
Taneja, Archit235e7db2011-03-14 23:28:21 -050094static const char * const dss_generic_clk_source_names[] = {
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +030095 [DSS_CLK_SRC_FCK] = "FCK",
96 [DSS_CLK_SRC_PLL1_1] = "PLL1:1",
97 [DSS_CLK_SRC_PLL1_2] = "PLL1:2",
Tomi Valkeinenb5d8c752016-05-17 14:12:35 +030098 [DSS_CLK_SRC_PLL1_3] = "PLL1:3",
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +030099 [DSS_CLK_SRC_PLL2_1] = "PLL2:1",
100 [DSS_CLK_SRC_PLL2_2] = "PLL2:2",
Tomi Valkeinenb5d8c752016-05-17 14:12:35 +0300101 [DSS_CLK_SRC_PLL2_3] = "PLL2:3",
102 [DSS_CLK_SRC_HDMI_PLL] = "HDMI PLL",
Archit Taneja067a57e2011-03-02 11:57:25 +0530103};
104
Laurent Pinchart360c2152018-02-13 14:00:28 +0200105static inline void dss_write_reg(struct dss_device *dss,
106 const struct dss_reg idx, u32 val)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200107{
Laurent Pinchart360c2152018-02-13 14:00:28 +0200108 __raw_writel(val, dss->base + idx.idx);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200109}
110
Laurent Pinchart360c2152018-02-13 14:00:28 +0200111static inline u32 dss_read_reg(struct dss_device *dss, const struct dss_reg idx)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200112{
Laurent Pinchart360c2152018-02-13 14:00:28 +0200113 return __raw_readl(dss->base + idx.idx);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200114}
115
Laurent Pinchart360c2152018-02-13 14:00:28 +0200116#define SR(dss, reg) \
117 dss->ctx[(DSS_##reg).idx / sizeof(u32)] = dss_read_reg(dss, DSS_##reg)
118#define RR(dss, reg) \
119 dss_write_reg(dss, DSS_##reg, dss->ctx[(DSS_##reg).idx / sizeof(u32)])
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200120
Laurent Pinchart360c2152018-02-13 14:00:28 +0200121static void dss_save_context(struct dss_device *dss)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200122{
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300123 DSSDBG("dss_save_context\n");
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200124
Laurent Pinchart360c2152018-02-13 14:00:28 +0200125 SR(dss, CONTROL);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200126
Laurent Pinchart360c2152018-02-13 14:00:28 +0200127 if (dss->feat->outputs[OMAP_DSS_CHANNEL_LCD] & OMAP_DSS_OUTPUT_SDI) {
128 SR(dss, SDI_CONTROL);
129 SR(dss, PLL_CONTROL);
Tomi Valkeinen6ec549e2011-02-24 14:18:50 +0200130 }
Tomi Valkeinen69f06052011-06-01 15:56:39 +0300131
Laurent Pinchart360c2152018-02-13 14:00:28 +0200132 dss->ctx_valid = true;
Tomi Valkeinen69f06052011-06-01 15:56:39 +0300133
134 DSSDBG("context saved\n");
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200135}
136
Laurent Pinchart360c2152018-02-13 14:00:28 +0200137static void dss_restore_context(struct dss_device *dss)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200138{
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300139 DSSDBG("dss_restore_context\n");
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200140
Laurent Pinchart360c2152018-02-13 14:00:28 +0200141 if (!dss->ctx_valid)
Tomi Valkeinen69f06052011-06-01 15:56:39 +0300142 return;
143
Laurent Pinchart360c2152018-02-13 14:00:28 +0200144 RR(dss, CONTROL);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200145
Laurent Pinchart360c2152018-02-13 14:00:28 +0200146 if (dss->feat->outputs[OMAP_DSS_CHANNEL_LCD] & OMAP_DSS_OUTPUT_SDI) {
147 RR(dss, SDI_CONTROL);
148 RR(dss, PLL_CONTROL);
Tomi Valkeinen6ec549e2011-02-24 14:18:50 +0200149 }
Tomi Valkeinen69f06052011-06-01 15:56:39 +0300150
151 DSSDBG("context restored\n");
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200152}
153
154#undef SR
155#undef RR
156
Laurent Pinchart27260992018-02-13 14:00:22 +0200157void dss_ctrl_pll_enable(struct dss_pll *pll, bool enable)
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530158{
Laurent Pinchartd11e5c82018-02-11 15:07:34 +0200159 unsigned int shift;
160 unsigned int val;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530161
Laurent Pinchart27260992018-02-13 14:00:22 +0200162 if (!pll->dss->syscon_pll_ctrl)
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530163 return;
164
165 val = !enable;
166
Laurent Pinchart27260992018-02-13 14:00:22 +0200167 switch (pll->id) {
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530168 case DSS_PLL_VIDEO1:
169 shift = 0;
170 break;
171 case DSS_PLL_VIDEO2:
172 shift = 1;
173 break;
174 case DSS_PLL_HDMI:
175 shift = 2;
176 break;
177 default:
Laurent Pinchart27260992018-02-13 14:00:22 +0200178 DSSERR("illegal DSS PLL ID %d\n", pll->id);
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530179 return;
180 }
181
Laurent Pinchart27260992018-02-13 14:00:22 +0200182 regmap_update_bits(pll->dss->syscon_pll_ctrl,
183 pll->dss->syscon_pll_ctrl_offset,
184 1 << shift, val << shift);
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530185}
186
Laurent Pinchart360c2152018-02-13 14:00:28 +0200187static int dss_ctrl_pll_set_control_mux(struct dss_device *dss,
188 enum dss_clk_source clk_src,
189 enum omap_channel channel)
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530190{
Laurent Pinchartd11e5c82018-02-11 15:07:34 +0200191 unsigned int shift, val;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530192
Laurent Pinchart360c2152018-02-13 14:00:28 +0200193 if (!dss->syscon_pll_ctrl)
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300194 return -EINVAL;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530195
196 switch (channel) {
197 case OMAP_DSS_CHANNEL_LCD:
198 shift = 3;
199
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300200 switch (clk_src) {
201 case DSS_CLK_SRC_PLL1_1:
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530202 val = 0; break;
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300203 case DSS_CLK_SRC_HDMI_PLL:
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530204 val = 1; break;
205 default:
206 DSSERR("error in PLL mux config for LCD\n");
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300207 return -EINVAL;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530208 }
209
210 break;
211 case OMAP_DSS_CHANNEL_LCD2:
212 shift = 5;
213
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300214 switch (clk_src) {
215 case DSS_CLK_SRC_PLL1_3:
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530216 val = 0; break;
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300217 case DSS_CLK_SRC_PLL2_3:
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530218 val = 1; break;
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300219 case DSS_CLK_SRC_HDMI_PLL:
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530220 val = 2; break;
221 default:
222 DSSERR("error in PLL mux config for LCD2\n");
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300223 return -EINVAL;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530224 }
225
226 break;
227 case OMAP_DSS_CHANNEL_LCD3:
228 shift = 7;
229
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300230 switch (clk_src) {
231 case DSS_CLK_SRC_PLL2_1:
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530232 val = 0; break;
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300233 case DSS_CLK_SRC_PLL1_3:
234 val = 1; break;
235 case DSS_CLK_SRC_HDMI_PLL:
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530236 val = 2; break;
237 default:
238 DSSERR("error in PLL mux config for LCD3\n");
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300239 return -EINVAL;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530240 }
241
242 break;
243 default:
244 DSSERR("error in PLL mux config\n");
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300245 return -EINVAL;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530246 }
247
Laurent Pinchart360c2152018-02-13 14:00:28 +0200248 regmap_update_bits(dss->syscon_pll_ctrl, dss->syscon_pll_ctrl_offset,
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530249 0x3 << shift, val << shift);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300250
251 return 0;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +0530252}
253
Laurent Pinchartd7157df2018-02-13 14:00:23 +0200254void dss_sdi_init(struct dss_device *dss, int datapairs)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200255{
256 u32 l;
257
258 BUG_ON(datapairs > 3 || datapairs < 1);
259
Laurent Pinchart360c2152018-02-13 14:00:28 +0200260 l = dss_read_reg(dss, DSS_SDI_CONTROL);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200261 l = FLD_MOD(l, 0xf, 19, 15); /* SDI_PDIV */
262 l = FLD_MOD(l, datapairs-1, 3, 2); /* SDI_PRSEL */
263 l = FLD_MOD(l, 2, 1, 0); /* SDI_BWSEL */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200264 dss_write_reg(dss, DSS_SDI_CONTROL, l);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200265
Laurent Pinchart360c2152018-02-13 14:00:28 +0200266 l = dss_read_reg(dss, DSS_PLL_CONTROL);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200267 l = FLD_MOD(l, 0x7, 25, 22); /* SDI_PLL_FREQSEL */
268 l = FLD_MOD(l, 0xb, 16, 11); /* SDI_PLL_REGN */
269 l = FLD_MOD(l, 0xb4, 10, 1); /* SDI_PLL_REGM */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200270 dss_write_reg(dss, DSS_PLL_CONTROL, l);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200271}
272
Laurent Pinchartd7157df2018-02-13 14:00:23 +0200273int dss_sdi_enable(struct dss_device *dss)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200274{
275 unsigned long timeout;
276
277 dispc_pck_free_enable(1);
278
279 /* Reset SDI PLL */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200280 REG_FLD_MOD(dss, DSS_PLL_CONTROL, 1, 18, 18); /* SDI_PLL_SYSRESET */
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200281 udelay(1); /* wait 2x PCLK */
282
283 /* Lock SDI PLL */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200284 REG_FLD_MOD(dss, DSS_PLL_CONTROL, 1, 28, 28); /* SDI_PLL_GOBIT */
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200285
286 /* Waiting for PLL lock request to complete */
287 timeout = jiffies + msecs_to_jiffies(500);
Laurent Pinchart360c2152018-02-13 14:00:28 +0200288 while (dss_read_reg(dss, DSS_SDI_STATUS) & (1 << 6)) {
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200289 if (time_after_eq(jiffies, timeout)) {
290 DSSERR("PLL lock request timed out\n");
291 goto err1;
292 }
293 }
294
295 /* Clearing PLL_GO bit */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200296 REG_FLD_MOD(dss, DSS_PLL_CONTROL, 0, 28, 28);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200297
298 /* Waiting for PLL to lock */
299 timeout = jiffies + msecs_to_jiffies(500);
Laurent Pinchart360c2152018-02-13 14:00:28 +0200300 while (!(dss_read_reg(dss, DSS_SDI_STATUS) & (1 << 5))) {
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200301 if (time_after_eq(jiffies, timeout)) {
302 DSSERR("PLL lock timed out\n");
303 goto err1;
304 }
305 }
306
307 dispc_lcd_enable_signal(1);
308
309 /* Waiting for SDI reset to complete */
310 timeout = jiffies + msecs_to_jiffies(500);
Laurent Pinchart360c2152018-02-13 14:00:28 +0200311 while (!(dss_read_reg(dss, DSS_SDI_STATUS) & (1 << 2))) {
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200312 if (time_after_eq(jiffies, timeout)) {
313 DSSERR("SDI reset timed out\n");
314 goto err2;
315 }
316 }
317
318 return 0;
319
320 err2:
321 dispc_lcd_enable_signal(0);
322 err1:
323 /* Reset SDI PLL */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200324 REG_FLD_MOD(dss, DSS_PLL_CONTROL, 0, 18, 18); /* SDI_PLL_SYSRESET */
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200325
326 dispc_pck_free_enable(0);
327
328 return -ETIMEDOUT;
329}
330
Laurent Pinchartd7157df2018-02-13 14:00:23 +0200331void dss_sdi_disable(struct dss_device *dss)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200332{
333 dispc_lcd_enable_signal(0);
334
335 dispc_pck_free_enable(0);
336
337 /* Reset SDI PLL */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200338 REG_FLD_MOD(dss, DSS_PLL_CONTROL, 0, 18, 18); /* SDI_PLL_SYSRESET */
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200339}
340
Tomi Valkeinen407bd562016-05-17 13:50:55 +0300341const char *dss_get_clk_source_name(enum dss_clk_source clk_src)
Archit Taneja067a57e2011-03-02 11:57:25 +0530342{
Taneja, Archit235e7db2011-03-14 23:28:21 -0500343 return dss_generic_clk_source_names[clk_src];
Archit Taneja067a57e2011-03-02 11:57:25 +0530344}
345
Laurent Pinchart9be9d7e2017-10-13 17:59:02 +0300346#if defined(CONFIG_OMAP2_DSS_DEBUGFS)
Laurent Pinchart360c2152018-02-13 14:00:28 +0200347static void dss_dump_clocks(struct dss_device *dss, struct seq_file *s)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200348{
Tomi Valkeinen557a1542016-05-17 13:49:18 +0300349 const char *fclk_name;
Tomi Valkeinen0acf6592011-03-14 07:28:57 -0500350 unsigned long fclk_rate;
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200351
Laurent Pinchart360c2152018-02-13 14:00:28 +0200352 if (dss_runtime_get(dss))
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300353 return;
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200354
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200355 seq_printf(s, "- DSS -\n");
356
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300357 fclk_name = dss_get_clk_source_name(DSS_CLK_SRC_FCK);
Laurent Pinchart360c2152018-02-13 14:00:28 +0200358 fclk_rate = clk_get_rate(dss->dss_clk);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200359
Tomi Valkeinen557a1542016-05-17 13:49:18 +0300360 seq_printf(s, "%s = %lu\n",
361 fclk_name,
Tomi Valkeinen9c15d762013-11-01 11:36:10 +0200362 fclk_rate);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200363
Laurent Pinchart360c2152018-02-13 14:00:28 +0200364 dss_runtime_put(dss);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200365}
Laurent Pinchart9be9d7e2017-10-13 17:59:02 +0300366#endif
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200367
Tomi Valkeinene40402c2012-03-02 18:01:07 +0200368static void dss_dump_regs(struct seq_file *s)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200369{
Laurent Pinchart360c2152018-02-13 14:00:28 +0200370 struct dss_device *dss = s->private;
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200371
Laurent Pinchart360c2152018-02-13 14:00:28 +0200372#define DUMPREG(dss, r) seq_printf(s, "%-35s %08x\n", #r, dss_read_reg(dss, r))
373
374 if (dss_runtime_get(dss))
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300375 return;
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200376
Laurent Pinchart360c2152018-02-13 14:00:28 +0200377 DUMPREG(dss, DSS_REVISION);
378 DUMPREG(dss, DSS_SYSCONFIG);
379 DUMPREG(dss, DSS_SYSSTATUS);
380 DUMPREG(dss, DSS_CONTROL);
Tomi Valkeinen6ec549e2011-02-24 14:18:50 +0200381
Laurent Pinchart360c2152018-02-13 14:00:28 +0200382 if (dss->feat->outputs[OMAP_DSS_CHANNEL_LCD] & OMAP_DSS_OUTPUT_SDI) {
383 DUMPREG(dss, DSS_SDI_CONTROL);
384 DUMPREG(dss, DSS_PLL_CONTROL);
385 DUMPREG(dss, DSS_SDI_STATUS);
Tomi Valkeinen6ec549e2011-02-24 14:18:50 +0200386 }
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200387
Laurent Pinchart360c2152018-02-13 14:00:28 +0200388 dss_runtime_put(dss);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200389#undef DUMPREG
390}
391
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300392static int dss_get_channel_index(enum omap_channel channel)
393{
394 switch (channel) {
395 case OMAP_DSS_CHANNEL_LCD:
396 return 0;
397 case OMAP_DSS_CHANNEL_LCD2:
398 return 1;
399 case OMAP_DSS_CHANNEL_LCD3:
400 return 2;
401 default:
402 WARN_ON(1);
403 return 0;
404 }
405}
406
Laurent Pinchart360c2152018-02-13 14:00:28 +0200407static void dss_select_dispc_clk_source(struct dss_device *dss,
408 enum dss_clk_source clk_src)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200409{
Tomi Valkeinen2f18c4d2010-01-08 18:00:36 +0200410 int b;
411
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300412 /*
413 * We always use PRCM clock as the DISPC func clock, except on DSS3,
414 * where we don't have separate DISPC and LCD clock sources.
415 */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200416 if (WARN_ON(dss->feat->has_lcd_clk_src && clk_src != DSS_CLK_SRC_FCK))
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300417 return;
418
Taneja, Archit66534e82011-03-08 05:50:34 -0600419 switch (clk_src) {
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300420 case DSS_CLK_SRC_FCK:
Taneja, Archit66534e82011-03-08 05:50:34 -0600421 b = 0;
422 break;
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300423 case DSS_CLK_SRC_PLL1_1:
Taneja, Archit66534e82011-03-08 05:50:34 -0600424 b = 1;
Taneja, Archit66534e82011-03-08 05:50:34 -0600425 break;
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300426 case DSS_CLK_SRC_PLL2_1:
Archit Taneja5a8b5722011-05-12 17:26:29 +0530427 b = 2;
Archit Taneja5a8b5722011-05-12 17:26:29 +0530428 break;
Taneja, Archit66534e82011-03-08 05:50:34 -0600429 default:
430 BUG();
Tomi Valkeinenc6eee962012-05-18 11:47:02 +0300431 return;
Taneja, Archit66534e82011-03-08 05:50:34 -0600432 }
Tomi Valkeinene406f902010-06-09 15:28:12 +0300433
Laurent Pinchart360c2152018-02-13 14:00:28 +0200434 REG_FLD_MOD(dss, DSS_CONTROL, b, /* DISPC_CLK_SWITCH */
435 dss->feat->dispc_clk_switch.start,
436 dss->feat->dispc_clk_switch.end);
Tomi Valkeinen2f18c4d2010-01-08 18:00:36 +0200437
Laurent Pinchart360c2152018-02-13 14:00:28 +0200438 dss->dispc_clk_source = clk_src;
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200439}
440
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200441void dss_select_dsi_clk_source(struct dss_device *dss, int dsi_module,
442 enum dss_clk_source clk_src)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200443{
Archit Tanejaa2e5d822012-05-07 16:51:35 +0530444 int b, pos;
Tomi Valkeinen2f18c4d2010-01-08 18:00:36 +0200445
Taneja, Archit66534e82011-03-08 05:50:34 -0600446 switch (clk_src) {
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300447 case DSS_CLK_SRC_FCK:
Taneja, Archit66534e82011-03-08 05:50:34 -0600448 b = 0;
449 break;
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300450 case DSS_CLK_SRC_PLL1_2:
Archit Taneja5a8b5722011-05-12 17:26:29 +0530451 BUG_ON(dsi_module != 0);
Taneja, Archit66534e82011-03-08 05:50:34 -0600452 b = 1;
Taneja, Archit66534e82011-03-08 05:50:34 -0600453 break;
Tomi Valkeinen3b63ca72016-05-17 14:01:10 +0300454 case DSS_CLK_SRC_PLL2_2:
Archit Taneja5a8b5722011-05-12 17:26:29 +0530455 BUG_ON(dsi_module != 1);
456 b = 1;
Archit Taneja5a8b5722011-05-12 17:26:29 +0530457 break;
Taneja, Archit66534e82011-03-08 05:50:34 -0600458 default:
459 BUG();
Tomi Valkeinenc6eee962012-05-18 11:47:02 +0300460 return;
Taneja, Archit66534e82011-03-08 05:50:34 -0600461 }
Tomi Valkeinene406f902010-06-09 15:28:12 +0300462
Archit Tanejaa2e5d822012-05-07 16:51:35 +0530463 pos = dsi_module == 0 ? 1 : 10;
Laurent Pinchart360c2152018-02-13 14:00:28 +0200464 REG_FLD_MOD(dss, DSS_CONTROL, b, pos, pos); /* DSIx_CLK_SWITCH */
Tomi Valkeinen2f18c4d2010-01-08 18:00:36 +0200465
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200466 dss->dsi_clk_source[dsi_module] = clk_src;
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200467}
468
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200469static int dss_lcd_clk_mux_dra7(struct dss_device *dss,
470 enum omap_channel channel,
471 enum dss_clk_source clk_src)
Taneja, Architea751592011-03-08 05:50:35 -0600472{
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300473 const u8 ctrl_bits[] = {
474 [OMAP_DSS_CHANNEL_LCD] = 0,
475 [OMAP_DSS_CHANNEL_LCD2] = 12,
476 [OMAP_DSS_CHANNEL_LCD3] = 19,
477 };
478
479 u8 ctrl_bit = ctrl_bits[channel];
480 int r;
481
482 if (clk_src == DSS_CLK_SRC_FCK) {
483 /* LCDx_CLK_SWITCH */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200484 REG_FLD_MOD(dss, DSS_CONTROL, 0, ctrl_bit, ctrl_bit);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300485 return -EINVAL;
486 }
487
Laurent Pinchart360c2152018-02-13 14:00:28 +0200488 r = dss_ctrl_pll_set_control_mux(dss, clk_src, channel);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300489 if (r)
490 return r;
491
Laurent Pinchart360c2152018-02-13 14:00:28 +0200492 REG_FLD_MOD(dss, DSS_CONTROL, 1, ctrl_bit, ctrl_bit);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300493
494 return 0;
495}
496
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200497static int dss_lcd_clk_mux_omap5(struct dss_device *dss,
498 enum omap_channel channel,
499 enum dss_clk_source clk_src)
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300500{
501 const u8 ctrl_bits[] = {
502 [OMAP_DSS_CHANNEL_LCD] = 0,
503 [OMAP_DSS_CHANNEL_LCD2] = 12,
504 [OMAP_DSS_CHANNEL_LCD3] = 19,
505 };
506 const enum dss_clk_source allowed_plls[] = {
507 [OMAP_DSS_CHANNEL_LCD] = DSS_CLK_SRC_PLL1_1,
508 [OMAP_DSS_CHANNEL_LCD2] = DSS_CLK_SRC_FCK,
509 [OMAP_DSS_CHANNEL_LCD3] = DSS_CLK_SRC_PLL2_1,
510 };
511
512 u8 ctrl_bit = ctrl_bits[channel];
513
514 if (clk_src == DSS_CLK_SRC_FCK) {
515 /* LCDx_CLK_SWITCH */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200516 REG_FLD_MOD(dss, DSS_CONTROL, 0, ctrl_bit, ctrl_bit);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300517 return -EINVAL;
518 }
519
520 if (WARN_ON(allowed_plls[channel] != clk_src))
521 return -EINVAL;
522
Laurent Pinchart360c2152018-02-13 14:00:28 +0200523 REG_FLD_MOD(dss, DSS_CONTROL, 1, ctrl_bit, ctrl_bit);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300524
525 return 0;
526}
527
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200528static int dss_lcd_clk_mux_omap4(struct dss_device *dss,
529 enum omap_channel channel,
530 enum dss_clk_source clk_src)
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300531{
532 const u8 ctrl_bits[] = {
533 [OMAP_DSS_CHANNEL_LCD] = 0,
534 [OMAP_DSS_CHANNEL_LCD2] = 12,
535 };
536 const enum dss_clk_source allowed_plls[] = {
537 [OMAP_DSS_CHANNEL_LCD] = DSS_CLK_SRC_PLL1_1,
538 [OMAP_DSS_CHANNEL_LCD2] = DSS_CLK_SRC_PLL2_1,
539 };
540
541 u8 ctrl_bit = ctrl_bits[channel];
542
543 if (clk_src == DSS_CLK_SRC_FCK) {
544 /* LCDx_CLK_SWITCH */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200545 REG_FLD_MOD(dss, DSS_CONTROL, 0, ctrl_bit, ctrl_bit);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300546 return 0;
547 }
548
549 if (WARN_ON(allowed_plls[channel] != clk_src))
550 return -EINVAL;
551
Laurent Pinchart360c2152018-02-13 14:00:28 +0200552 REG_FLD_MOD(dss, DSS_CONTROL, 1, ctrl_bit, ctrl_bit);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300553
554 return 0;
555}
556
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200557void dss_select_lcd_clk_source(struct dss_device *dss,
558 enum omap_channel channel,
559 enum dss_clk_source clk_src)
Taneja, Architea751592011-03-08 05:50:35 -0600560{
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300561 int idx = dss_get_channel_index(channel);
562 int r;
Taneja, Architea751592011-03-08 05:50:35 -0600563
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200564 if (!dss->feat->has_lcd_clk_src) {
Laurent Pinchart360c2152018-02-13 14:00:28 +0200565 dss_select_dispc_clk_source(dss, clk_src);
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200566 dss->lcd_clk_source[idx] = clk_src;
Taneja, Architea751592011-03-08 05:50:35 -0600567 return;
Tomi Valkeinena5b83992012-10-22 16:58:36 +0300568 }
Taneja, Architea751592011-03-08 05:50:35 -0600569
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200570 r = dss->feat->ops->select_lcd_source(dss, channel, clk_src);
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300571 if (r)
Tomi Valkeinenc6eee962012-05-18 11:47:02 +0300572 return;
Taneja, Architea751592011-03-08 05:50:35 -0600573
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200574 dss->lcd_clk_source[idx] = clk_src;
Taneja, Architea751592011-03-08 05:50:35 -0600575}
576
Laurent Pinchart3cc62aa2018-02-13 14:00:25 +0200577enum dss_clk_source dss_get_dispc_clk_source(struct dss_device *dss)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200578{
Laurent Pinchart3cc62aa2018-02-13 14:00:25 +0200579 return dss->dispc_clk_source;
Tomi Valkeinen2f18c4d2010-01-08 18:00:36 +0200580}
581
Laurent Pinchart3cc62aa2018-02-13 14:00:25 +0200582enum dss_clk_source dss_get_dsi_clk_source(struct dss_device *dss,
583 int dsi_module)
Tomi Valkeinen2f18c4d2010-01-08 18:00:36 +0200584{
Laurent Pinchart3cc62aa2018-02-13 14:00:25 +0200585 return dss->dsi_clk_source[dsi_module];
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200586}
587
Laurent Pinchart3cc62aa2018-02-13 14:00:25 +0200588enum dss_clk_source dss_get_lcd_clk_source(struct dss_device *dss,
589 enum omap_channel channel)
Taneja, Architea751592011-03-08 05:50:35 -0600590{
Laurent Pinchart3cc62aa2018-02-13 14:00:25 +0200591 if (dss->feat->has_lcd_clk_src) {
Tomi Valkeinenc63b1ec2016-05-17 15:46:19 +0300592 int idx = dss_get_channel_index(channel);
Laurent Pinchart3cc62aa2018-02-13 14:00:25 +0200593 return dss->lcd_clk_source[idx];
Archit Taneja89976f22011-03-31 13:23:35 +0530594 } else {
595 /* LCD_CLK source is the same as DISPC_FCLK source for
596 * OMAP2 and OMAP3 */
Laurent Pinchart3cc62aa2018-02-13 14:00:25 +0200597 return dss->dispc_clk_source;
Archit Taneja89976f22011-03-31 13:23:35 +0530598 }
Taneja, Architea751592011-03-08 05:50:35 -0600599}
600
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200601bool dss_div_calc(struct dss_device *dss, unsigned long pck,
602 unsigned long fck_min, dss_div_calc_func func, void *data)
Tomi Valkeinen43417822013-03-05 16:34:05 +0200603{
604 int fckd, fckd_start, fckd_stop;
605 unsigned long fck;
606 unsigned long fck_hw_max;
607 unsigned long fckd_hw_max;
608 unsigned long prate;
Laurent Pinchartd11e5c82018-02-11 15:07:34 +0200609 unsigned int m;
Tomi Valkeinen43417822013-03-05 16:34:05 +0200610
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200611 fck_hw_max = dss->feat->fck_freq_max;
Tomi Valkeinenfc1fe6e2013-10-31 16:42:13 +0200612
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200613 if (dss->parent_clk == NULL) {
Laurent Pinchartd11e5c82018-02-11 15:07:34 +0200614 unsigned int pckd;
Tomi Valkeinenfc1fe6e2013-10-31 16:42:13 +0200615
616 pckd = fck_hw_max / pck;
617
618 fck = pck * pckd;
619
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200620 fck = clk_round_rate(dss->dss_clk, fck);
Tomi Valkeinenfc1fe6e2013-10-31 16:42:13 +0200621
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200622 return func(fck, data);
Tomi Valkeinen43417822013-03-05 16:34:05 +0200623 }
624
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200625 fckd_hw_max = dss->feat->fck_div_max;
Tomi Valkeinen43417822013-03-05 16:34:05 +0200626
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200627 m = dss->feat->dss_fck_multiplier;
628 prate = clk_get_rate(dss->parent_clk);
Tomi Valkeinen43417822013-03-05 16:34:05 +0200629
630 fck_min = fck_min ? fck_min : 1;
631
Tomi Valkeinen648a55e2013-04-10 14:47:38 +0300632 fckd_start = min(prate * m / fck_min, fckd_hw_max);
633 fckd_stop = max(DIV_ROUND_UP(prate * m, fck_hw_max), 1ul);
Tomi Valkeinen43417822013-03-05 16:34:05 +0200634
635 for (fckd = fckd_start; fckd >= fckd_stop; --fckd) {
Tomi Valkeinend0e224f2014-02-13 11:36:22 +0200636 fck = DIV_ROUND_UP(prate, fckd) * m;
Tomi Valkeinen43417822013-03-05 16:34:05 +0200637
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200638 if (func(fck, data))
Tomi Valkeinen43417822013-03-05 16:34:05 +0200639 return true;
640 }
641
642 return false;
643}
644
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200645int dss_set_fck_rate(struct dss_device *dss, unsigned long rate)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200646{
Tomi Valkeinenada94432013-10-31 16:06:38 +0200647 int r;
648
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200649 DSSDBG("set fck to %lu\n", rate);
650
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200651 r = clk_set_rate(dss->dss_clk, rate);
Tomi Valkeinenada94432013-10-31 16:06:38 +0200652 if (r)
653 return r;
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200654
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200655 dss->dss_clk_rate = clk_get_rate(dss->dss_clk);
Tomi Valkeinen5aaee692012-12-12 10:37:03 +0200656
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200657 WARN_ONCE(dss->dss_clk_rate != rate, "clk rate mismatch: %lu != %lu",
658 dss->dss_clk_rate, rate);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200659
660 return 0;
661}
662
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200663unsigned long dss_get_dispc_clk_rate(struct dss_device *dss)
Tomi Valkeinen5aaee692012-12-12 10:37:03 +0200664{
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200665 return dss->dss_clk_rate;
Tomi Valkeinen5aaee692012-12-12 10:37:03 +0200666}
667
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200668unsigned long dss_get_max_fck_rate(struct dss_device *dss)
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +0300669{
Laurent Pinchart60f9c592018-02-13 14:00:26 +0200670 return dss->feat->fck_freq_max;
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +0300671}
672
Laurent Pinchart1ef904e2018-02-13 14:00:27 +0200673enum omap_dss_output_id dss_get_supported_outputs(struct dss_device *dss,
674 enum omap_channel channel)
Laurent Pinchart51919572017-08-05 01:44:18 +0300675{
Laurent Pinchart1ef904e2018-02-13 14:00:27 +0200676 return dss->feat->outputs[channel];
Laurent Pinchart51919572017-08-05 01:44:18 +0300677}
678
Laurent Pinchart360c2152018-02-13 14:00:28 +0200679static int dss_setup_default_clock(struct dss_device *dss)
Tomi Valkeinen13a1a2b2012-10-22 16:35:41 +0300680{
681 unsigned long max_dss_fck, prate;
Tomi Valkeinend0f58bd2013-10-31 14:44:23 +0200682 unsigned long fck;
Laurent Pinchartd11e5c82018-02-11 15:07:34 +0200683 unsigned int fck_div;
Tomi Valkeinen13a1a2b2012-10-22 16:35:41 +0300684 int r;
685
Laurent Pinchart360c2152018-02-13 14:00:28 +0200686 max_dss_fck = dss->feat->fck_freq_max;
Tomi Valkeinen13a1a2b2012-10-22 16:35:41 +0300687
Laurent Pinchart360c2152018-02-13 14:00:28 +0200688 if (dss->parent_clk == NULL) {
689 fck = clk_round_rate(dss->dss_clk, max_dss_fck);
Tomi Valkeinenfc1fe6e2013-10-31 16:42:13 +0200690 } else {
Laurent Pinchart360c2152018-02-13 14:00:28 +0200691 prate = clk_get_rate(dss->parent_clk);
Tomi Valkeinen13a1a2b2012-10-22 16:35:41 +0300692
Laurent Pinchart360c2152018-02-13 14:00:28 +0200693 fck_div = DIV_ROUND_UP(prate * dss->feat->dss_fck_multiplier,
Tomi Valkeinenfc1fe6e2013-10-31 16:42:13 +0200694 max_dss_fck);
Laurent Pinchart360c2152018-02-13 14:00:28 +0200695 fck = DIV_ROUND_UP(prate, fck_div)
696 * dss->feat->dss_fck_multiplier;
Tomi Valkeinenfc1fe6e2013-10-31 16:42:13 +0200697 }
Tomi Valkeinen13a1a2b2012-10-22 16:35:41 +0300698
Laurent Pinchart360c2152018-02-13 14:00:28 +0200699 r = dss_set_fck_rate(dss, fck);
Tomi Valkeinen13a1a2b2012-10-22 16:35:41 +0300700 if (r)
701 return r;
702
703 return 0;
704}
705
Laurent Pinchart1ef904e2018-02-13 14:00:27 +0200706void dss_set_venc_output(struct dss_device *dss, enum omap_dss_venc_type type)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200707{
708 int l = 0;
709
710 if (type == OMAP_DSS_VENC_TYPE_COMPOSITE)
711 l = 0;
712 else if (type == OMAP_DSS_VENC_TYPE_SVIDEO)
713 l = 1;
714 else
715 BUG();
716
717 /* venc out selection. 0 = comp, 1 = svideo */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200718 REG_FLD_MOD(dss, DSS_CONTROL, l, 6, 6);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200719}
720
Laurent Pinchart1ef904e2018-02-13 14:00:27 +0200721void dss_set_dac_pwrdn_bgz(struct dss_device *dss, bool enable)
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200722{
Laurent Pinchart360c2152018-02-13 14:00:28 +0200723 /* DAC Power-Down Control */
724 REG_FLD_MOD(dss, DSS_CONTROL, enable, 5, 5);
Tomi Valkeinen559d6702009-11-03 11:23:50 +0200725}
726
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200727void dss_select_hdmi_venc_clk_source(struct dss_device *dss,
728 enum dss_hdmi_venc_clk_source_select src)
Mythri P K7ed024a2011-03-09 16:31:38 +0530729{
Laurent Pinchart24ab1df2017-08-05 01:43:59 +0300730 enum omap_dss_output_id outputs;
731
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200732 outputs = dss->feat->outputs[OMAP_DSS_CHANNEL_DIGIT];
Ricardo Neri8aa2eed2012-08-01 07:56:40 -0500733
734 /* Complain about invalid selections */
Laurent Pinchart24ab1df2017-08-05 01:43:59 +0300735 WARN_ON((src == DSS_VENC_TV_CLK) && !(outputs & OMAP_DSS_OUTPUT_VENC));
736 WARN_ON((src == DSS_HDMI_M_PCLK) && !(outputs & OMAP_DSS_OUTPUT_HDMI));
Ricardo Neri8aa2eed2012-08-01 07:56:40 -0500737
738 /* Select only if we have options */
Laurent Pinchart24ab1df2017-08-05 01:43:59 +0300739 if ((outputs & OMAP_DSS_OUTPUT_VENC) &&
740 (outputs & OMAP_DSS_OUTPUT_HDMI))
Laurent Pinchart360c2152018-02-13 14:00:28 +0200741 /* VENC_HDMI_SWITCH */
742 REG_FLD_MOD(dss, DSS_CONTROL, src, 15, 15);
Mythri P K7ed024a2011-03-09 16:31:38 +0530743}
744
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200745static int dss_dpi_select_source_omap2_omap3(struct dss_device *dss, int port,
746 enum omap_channel channel)
Tomi Valkeinende09e452012-09-21 12:09:54 +0300747{
748 if (channel != OMAP_DSS_CHANNEL_LCD)
749 return -EINVAL;
750
751 return 0;
752}
753
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200754static int dss_dpi_select_source_omap4(struct dss_device *dss, int port,
755 enum omap_channel channel)
Tomi Valkeinende09e452012-09-21 12:09:54 +0300756{
757 int val;
758
759 switch (channel) {
760 case OMAP_DSS_CHANNEL_LCD2:
761 val = 0;
762 break;
763 case OMAP_DSS_CHANNEL_DIGIT:
764 val = 1;
765 break;
766 default:
767 return -EINVAL;
768 }
769
Laurent Pinchart360c2152018-02-13 14:00:28 +0200770 REG_FLD_MOD(dss, DSS_CONTROL, val, 17, 17);
Tomi Valkeinende09e452012-09-21 12:09:54 +0300771
772 return 0;
773}
774
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200775static int dss_dpi_select_source_omap5(struct dss_device *dss, int port,
776 enum omap_channel channel)
Tomi Valkeinende09e452012-09-21 12:09:54 +0300777{
778 int val;
779
780 switch (channel) {
781 case OMAP_DSS_CHANNEL_LCD:
782 val = 1;
783 break;
784 case OMAP_DSS_CHANNEL_LCD2:
785 val = 2;
786 break;
787 case OMAP_DSS_CHANNEL_LCD3:
788 val = 3;
789 break;
790 case OMAP_DSS_CHANNEL_DIGIT:
791 val = 0;
792 break;
793 default:
794 return -EINVAL;
795 }
796
Laurent Pinchart360c2152018-02-13 14:00:28 +0200797 REG_FLD_MOD(dss, DSS_CONTROL, val, 17, 16);
Tomi Valkeinende09e452012-09-21 12:09:54 +0300798
799 return 0;
800}
801
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200802static int dss_dpi_select_source_dra7xx(struct dss_device *dss, int port,
803 enum omap_channel channel)
Tomi Valkeinen6d817882014-12-31 11:23:31 +0200804{
805 switch (port) {
806 case 0:
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200807 return dss_dpi_select_source_omap5(dss, port, channel);
Tomi Valkeinen6d817882014-12-31 11:23:31 +0200808 case 1:
809 if (channel != OMAP_DSS_CHANNEL_LCD2)
810 return -EINVAL;
811 break;
812 case 2:
813 if (channel != OMAP_DSS_CHANNEL_LCD3)
814 return -EINVAL;
815 break;
816 default:
817 return -EINVAL;
818 }
819
820 return 0;
821}
822
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200823int dss_dpi_select_source(struct dss_device *dss, int port,
824 enum omap_channel channel)
Tomi Valkeinende09e452012-09-21 12:09:54 +0300825{
Laurent Pinchart8aea8e62018-02-13 14:00:24 +0200826 return dss->feat->ops->dpi_select_source(dss, port, channel);
Tomi Valkeinende09e452012-09-21 12:09:54 +0300827}
828
Laurent Pinchart360c2152018-02-13 14:00:28 +0200829static int dss_get_clocks(struct dss_device *dss)
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000830{
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300831 struct clk *clk;
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000832
Laurent Pinchart360c2152018-02-13 14:00:28 +0200833 clk = devm_clk_get(&dss->pdev->dev, "fck");
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300834 if (IS_ERR(clk)) {
835 DSSERR("can't get clock fck\n");
Archit Tanejab2c9c8e2013-04-08 11:55:00 +0300836 return PTR_ERR(clk);
Semwal, Sumita1a0dcc2011-03-01 02:42:14 -0600837 }
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000838
Laurent Pinchart360c2152018-02-13 14:00:28 +0200839 dss->dss_clk = clk;
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000840
Laurent Pinchart360c2152018-02-13 14:00:28 +0200841 if (dss->feat->parent_clk_name) {
842 clk = clk_get(NULL, dss->feat->parent_clk_name);
Aaro Koskinen8ad93752012-11-21 21:48:51 +0200843 if (IS_ERR(clk)) {
Laurent Pinchart360c2152018-02-13 14:00:28 +0200844 DSSERR("Failed to get %s\n",
845 dss->feat->parent_clk_name);
Archit Tanejab2c9c8e2013-04-08 11:55:00 +0300846 return PTR_ERR(clk);
Aaro Koskinen8ad93752012-11-21 21:48:51 +0200847 }
848 } else {
849 clk = NULL;
Tomi Valkeinen94c042c2011-05-16 13:43:04 +0300850 }
851
Laurent Pinchart360c2152018-02-13 14:00:28 +0200852 dss->parent_clk = clk;
Tomi Valkeinen94c042c2011-05-16 13:43:04 +0300853
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000854 return 0;
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000855}
856
Laurent Pinchart360c2152018-02-13 14:00:28 +0200857static void dss_put_clocks(struct dss_device *dss)
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000858{
Laurent Pinchart360c2152018-02-13 14:00:28 +0200859 if (dss->parent_clk)
860 clk_put(dss->parent_clk);
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000861}
862
Laurent Pinchart7b295252018-02-13 14:00:21 +0200863int dss_runtime_get(struct dss_device *dss)
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000864{
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300865 int r;
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000866
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300867 DSSDBG("dss_runtime_get\n");
868
Laurent Pinchart7b295252018-02-13 14:00:21 +0200869 r = pm_runtime_get_sync(&dss->pdev->dev);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300870 WARN_ON(r < 0);
871 return r < 0 ? r : 0;
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000872}
873
Laurent Pinchart7b295252018-02-13 14:00:21 +0200874void dss_runtime_put(struct dss_device *dss)
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000875{
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300876 int r;
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000877
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +0300878 DSSDBG("dss_runtime_put\n");
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000879
Laurent Pinchart7b295252018-02-13 14:00:21 +0200880 r = pm_runtime_put_sync(&dss->pdev->dev);
Tomi Valkeinen5be3aeb2012-06-27 16:37:18 +0300881 WARN_ON(r < 0 && r != -ENOSYS && r != -EBUSY);
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000882}
883
Laurent Pinchart7b295252018-02-13 14:00:21 +0200884struct dss_device *dss_get_device(struct device *dev)
885{
Laurent Pinchart360c2152018-02-13 14:00:28 +0200886 return dev_get_drvdata(dev);
Laurent Pinchart7b295252018-02-13 14:00:21 +0200887}
888
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000889/* DEBUGFS */
Chandrabhanu Mahapatra1b3bcb32012-09-29 11:25:42 +0530890#if defined(CONFIG_OMAP2_DSS_DEBUGFS)
Laurent Pinchart11765d12017-08-05 01:44:01 +0300891static void dss_debug_dump_clocks(struct seq_file *s)
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000892{
Laurent Pinchart360c2152018-02-13 14:00:28 +0200893 struct dss_device *dss = s->private;
894
895 dss_dump_clocks(dss, s);
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000896 dispc_dump_clocks(s);
897#ifdef CONFIG_OMAP2_DSS_DSI
898 dsi_dump_clocks(s);
899#endif
900}
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +0000901
Laurent Pinchart11765d12017-08-05 01:44:01 +0300902static int dss_debug_show(struct seq_file *s, void *unused)
903{
904 void (*func)(struct seq_file *) = s->private;
905
906 func(s);
907 return 0;
908}
909
910static int dss_debug_open(struct inode *inode, struct file *file)
911{
912 return single_open(file, dss_debug_show, inode->i_private);
913}
914
915static const struct file_operations dss_debug_fops = {
916 .open = dss_debug_open,
917 .read = seq_read,
918 .llseek = seq_lseek,
919 .release = single_release,
920};
921
922static struct dentry *dss_debugfs_dir;
923
Laurent Pinchart360c2152018-02-13 14:00:28 +0200924static int dss_initialize_debugfs(struct dss_device *dss)
Laurent Pinchart11765d12017-08-05 01:44:01 +0300925{
926 dss_debugfs_dir = debugfs_create_dir("omapdss", NULL);
927 if (IS_ERR(dss_debugfs_dir)) {
928 int err = PTR_ERR(dss_debugfs_dir);
929
930 dss_debugfs_dir = NULL;
931 return err;
932 }
933
934 debugfs_create_file("clk", S_IRUGO, dss_debugfs_dir,
935 &dss_debug_dump_clocks, &dss_debug_fops);
936
937 return 0;
938}
939
940static void dss_uninitialize_debugfs(void)
941{
942 if (dss_debugfs_dir)
943 debugfs_remove_recursive(dss_debugfs_dir);
944}
945
946int dss_debugfs_create_file(const char *name, void (*write)(struct seq_file *))
947{
948 struct dentry *d;
949
950 d = debugfs_create_file(name, S_IRUGO, dss_debugfs_dir,
951 write, &dss_debug_fops);
952
953 return PTR_ERR_OR_ZERO(d);
954}
955#else /* CONFIG_OMAP2_DSS_DEBUGFS */
Laurent Pinchart360c2152018-02-13 14:00:28 +0200956static inline int dss_initialize_debugfs(struct dss_device *dss)
Laurent Pinchart11765d12017-08-05 01:44:01 +0300957{
958 return 0;
959}
960static inline void dss_uninitialize_debugfs(void)
961{
962}
963#endif /* CONFIG_OMAP2_DSS_DEBUGFS */
Archit Taneja387ce9f2014-05-22 17:01:57 +0530964
Laurent Pinchartfecea252017-08-05 01:43:52 +0300965static const struct dss_ops dss_ops_omap2_omap3 = {
966 .dpi_select_source = &dss_dpi_select_source_omap2_omap3,
967};
968
969static const struct dss_ops dss_ops_omap4 = {
970 .dpi_select_source = &dss_dpi_select_source_omap4,
971 .select_lcd_source = &dss_lcd_clk_mux_omap4,
972};
973
974static const struct dss_ops dss_ops_omap5 = {
975 .dpi_select_source = &dss_dpi_select_source_omap5,
976 .select_lcd_source = &dss_lcd_clk_mux_omap5,
977};
978
979static const struct dss_ops dss_ops_dra7 = {
980 .dpi_select_source = &dss_dpi_select_source_dra7xx,
981 .select_lcd_source = &dss_lcd_clk_mux_dra7,
982};
983
Tomi Valkeinen234f9a22014-12-11 15:59:31 +0200984static const enum omap_display_type omap2plus_ports[] = {
Archit Taneja387ce9f2014-05-22 17:01:57 +0530985 OMAP_DISPLAY_TYPE_DPI,
986};
987
Tomi Valkeinen234f9a22014-12-11 15:59:31 +0200988static const enum omap_display_type omap34xx_ports[] = {
Archit Taneja387ce9f2014-05-22 17:01:57 +0530989 OMAP_DISPLAY_TYPE_DPI,
990 OMAP_DISPLAY_TYPE_SDI,
991};
992
Tomi Valkeinen6d817882014-12-31 11:23:31 +0200993static const enum omap_display_type dra7xx_ports[] = {
994 OMAP_DISPLAY_TYPE_DPI,
995 OMAP_DISPLAY_TYPE_DPI,
996 OMAP_DISPLAY_TYPE_DPI,
997};
998
Laurent Pinchart51919572017-08-05 01:44:18 +0300999static const enum omap_dss_output_id omap2_dss_supported_outputs[] = {
1000 /* OMAP_DSS_CHANNEL_LCD */
1001 OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI,
1002
1003 /* OMAP_DSS_CHANNEL_DIGIT */
1004 OMAP_DSS_OUTPUT_VENC,
1005};
1006
1007static const enum omap_dss_output_id omap3430_dss_supported_outputs[] = {
1008 /* OMAP_DSS_CHANNEL_LCD */
1009 OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI |
1010 OMAP_DSS_OUTPUT_SDI | OMAP_DSS_OUTPUT_DSI1,
1011
1012 /* OMAP_DSS_CHANNEL_DIGIT */
1013 OMAP_DSS_OUTPUT_VENC,
1014};
1015
1016static const enum omap_dss_output_id omap3630_dss_supported_outputs[] = {
1017 /* OMAP_DSS_CHANNEL_LCD */
1018 OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI |
1019 OMAP_DSS_OUTPUT_DSI1,
1020
1021 /* OMAP_DSS_CHANNEL_DIGIT */
1022 OMAP_DSS_OUTPUT_VENC,
1023};
1024
1025static const enum omap_dss_output_id am43xx_dss_supported_outputs[] = {
1026 /* OMAP_DSS_CHANNEL_LCD */
1027 OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI,
1028};
1029
1030static const enum omap_dss_output_id omap4_dss_supported_outputs[] = {
1031 /* OMAP_DSS_CHANNEL_LCD */
1032 OMAP_DSS_OUTPUT_DBI | OMAP_DSS_OUTPUT_DSI1,
1033
1034 /* OMAP_DSS_CHANNEL_DIGIT */
1035 OMAP_DSS_OUTPUT_VENC | OMAP_DSS_OUTPUT_HDMI,
1036
1037 /* OMAP_DSS_CHANNEL_LCD2 */
1038 OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI |
1039 OMAP_DSS_OUTPUT_DSI2,
1040};
1041
1042static const enum omap_dss_output_id omap5_dss_supported_outputs[] = {
1043 /* OMAP_DSS_CHANNEL_LCD */
1044 OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI |
1045 OMAP_DSS_OUTPUT_DSI1 | OMAP_DSS_OUTPUT_DSI2,
1046
1047 /* OMAP_DSS_CHANNEL_DIGIT */
1048 OMAP_DSS_OUTPUT_HDMI,
1049
1050 /* OMAP_DSS_CHANNEL_LCD2 */
1051 OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI |
1052 OMAP_DSS_OUTPUT_DSI1,
1053
1054 /* OMAP_DSS_CHANNEL_LCD3 */
1055 OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI |
1056 OMAP_DSS_OUTPUT_DSI2,
1057};
1058
Tomi Valkeinenede92692015-06-04 14:12:16 +03001059static const struct dss_features omap24xx_dss_feats = {
Laurent Pinchartb8dab2b2017-08-05 01:43:56 +03001060 .model = DSS_MODEL_OMAP2,
Tomi Valkeinen6e555e22013-11-01 11:26:43 +02001061 /*
1062 * fck div max is really 16, but the divider range has gaps. The range
1063 * from 1 to 6 has no gaps, so let's use that as a max.
1064 */
1065 .fck_div_max = 6,
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +03001066 .fck_freq_max = 133000000,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001067 .dss_fck_multiplier = 2,
Tomi Valkeinenada94432013-10-31 16:06:38 +02001068 .parent_clk_name = "core_ck",
Archit Taneja387ce9f2014-05-22 17:01:57 +05301069 .ports = omap2plus_ports,
1070 .num_ports = ARRAY_SIZE(omap2plus_ports),
Laurent Pinchart51919572017-08-05 01:44:18 +03001071 .outputs = omap2_dss_supported_outputs,
Laurent Pinchartfecea252017-08-05 01:43:52 +03001072 .ops = &dss_ops_omap2_omap3,
Laurent Pinchart6d85d4a2017-08-05 01:44:07 +03001073 .dispc_clk_switch = { 0, 0 },
Laurent Pinchart4569ab72017-08-05 01:44:13 +03001074 .has_lcd_clk_src = false,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001075};
1076
Tomi Valkeinenede92692015-06-04 14:12:16 +03001077static const struct dss_features omap34xx_dss_feats = {
Laurent Pinchartb8dab2b2017-08-05 01:43:56 +03001078 .model = DSS_MODEL_OMAP3,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001079 .fck_div_max = 16,
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +03001080 .fck_freq_max = 173000000,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001081 .dss_fck_multiplier = 2,
Tomi Valkeinenada94432013-10-31 16:06:38 +02001082 .parent_clk_name = "dpll4_ck",
Archit Taneja387ce9f2014-05-22 17:01:57 +05301083 .ports = omap34xx_ports,
Laurent Pinchart51919572017-08-05 01:44:18 +03001084 .outputs = omap3430_dss_supported_outputs,
Archit Taneja387ce9f2014-05-22 17:01:57 +05301085 .num_ports = ARRAY_SIZE(omap34xx_ports),
Laurent Pinchartfecea252017-08-05 01:43:52 +03001086 .ops = &dss_ops_omap2_omap3,
Laurent Pinchart6d85d4a2017-08-05 01:44:07 +03001087 .dispc_clk_switch = { 0, 0 },
Laurent Pinchart4569ab72017-08-05 01:44:13 +03001088 .has_lcd_clk_src = false,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001089};
1090
Tomi Valkeinenede92692015-06-04 14:12:16 +03001091static const struct dss_features omap3630_dss_feats = {
Laurent Pinchartb8dab2b2017-08-05 01:43:56 +03001092 .model = DSS_MODEL_OMAP3,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001093 .fck_div_max = 32,
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +03001094 .fck_freq_max = 173000000,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001095 .dss_fck_multiplier = 1,
Tomi Valkeinenada94432013-10-31 16:06:38 +02001096 .parent_clk_name = "dpll4_ck",
Archit Taneja387ce9f2014-05-22 17:01:57 +05301097 .ports = omap2plus_ports,
1098 .num_ports = ARRAY_SIZE(omap2plus_ports),
Laurent Pinchart51919572017-08-05 01:44:18 +03001099 .outputs = omap3630_dss_supported_outputs,
Laurent Pinchartfecea252017-08-05 01:43:52 +03001100 .ops = &dss_ops_omap2_omap3,
Laurent Pinchart6d85d4a2017-08-05 01:44:07 +03001101 .dispc_clk_switch = { 0, 0 },
Laurent Pinchart4569ab72017-08-05 01:44:13 +03001102 .has_lcd_clk_src = false,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001103};
1104
Tomi Valkeinenede92692015-06-04 14:12:16 +03001105static const struct dss_features omap44xx_dss_feats = {
Laurent Pinchartb8dab2b2017-08-05 01:43:56 +03001106 .model = DSS_MODEL_OMAP4,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001107 .fck_div_max = 32,
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +03001108 .fck_freq_max = 186000000,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001109 .dss_fck_multiplier = 1,
Tomi Valkeinenada94432013-10-31 16:06:38 +02001110 .parent_clk_name = "dpll_per_x2_ck",
Archit Taneja387ce9f2014-05-22 17:01:57 +05301111 .ports = omap2plus_ports,
1112 .num_ports = ARRAY_SIZE(omap2plus_ports),
Laurent Pinchart51919572017-08-05 01:44:18 +03001113 .outputs = omap4_dss_supported_outputs,
Laurent Pinchartfecea252017-08-05 01:43:52 +03001114 .ops = &dss_ops_omap4,
Laurent Pinchart6d85d4a2017-08-05 01:44:07 +03001115 .dispc_clk_switch = { 9, 8 },
Laurent Pinchart4569ab72017-08-05 01:44:13 +03001116 .has_lcd_clk_src = true,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001117};
1118
Tomi Valkeinenede92692015-06-04 14:12:16 +03001119static const struct dss_features omap54xx_dss_feats = {
Laurent Pinchartb8dab2b2017-08-05 01:43:56 +03001120 .model = DSS_MODEL_OMAP5,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001121 .fck_div_max = 64,
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +03001122 .fck_freq_max = 209250000,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001123 .dss_fck_multiplier = 1,
Tomi Valkeinenada94432013-10-31 16:06:38 +02001124 .parent_clk_name = "dpll_per_x2_ck",
Archit Taneja387ce9f2014-05-22 17:01:57 +05301125 .ports = omap2plus_ports,
1126 .num_ports = ARRAY_SIZE(omap2plus_ports),
Laurent Pinchart51919572017-08-05 01:44:18 +03001127 .outputs = omap5_dss_supported_outputs,
Laurent Pinchartfecea252017-08-05 01:43:52 +03001128 .ops = &dss_ops_omap5,
Laurent Pinchart6d85d4a2017-08-05 01:44:07 +03001129 .dispc_clk_switch = { 9, 7 },
Laurent Pinchart4569ab72017-08-05 01:44:13 +03001130 .has_lcd_clk_src = true,
Tomi Valkeinen84273a92012-09-21 12:03:31 +03001131};
1132
Tomi Valkeinenede92692015-06-04 14:12:16 +03001133static const struct dss_features am43xx_dss_feats = {
Laurent Pinchartb8dab2b2017-08-05 01:43:56 +03001134 .model = DSS_MODEL_OMAP3,
Sathya Prakash M Rd6279d42014-03-24 16:31:51 +05301135 .fck_div_max = 0,
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +03001136 .fck_freq_max = 200000000,
Sathya Prakash M Rd6279d42014-03-24 16:31:51 +05301137 .dss_fck_multiplier = 0,
1138 .parent_clk_name = NULL,
Archit Taneja387ce9f2014-05-22 17:01:57 +05301139 .ports = omap2plus_ports,
1140 .num_ports = ARRAY_SIZE(omap2plus_ports),
Laurent Pinchart51919572017-08-05 01:44:18 +03001141 .outputs = am43xx_dss_supported_outputs,
Laurent Pinchartfecea252017-08-05 01:43:52 +03001142 .ops = &dss_ops_omap2_omap3,
Laurent Pinchart6d85d4a2017-08-05 01:44:07 +03001143 .dispc_clk_switch = { 0, 0 },
Laurent Pinchart4569ab72017-08-05 01:44:13 +03001144 .has_lcd_clk_src = true,
Sathya Prakash M Rd6279d42014-03-24 16:31:51 +05301145};
1146
Tomi Valkeinenede92692015-06-04 14:12:16 +03001147static const struct dss_features dra7xx_dss_feats = {
Laurent Pinchartb8dab2b2017-08-05 01:43:56 +03001148 .model = DSS_MODEL_DRA7,
Tomi Valkeinen6d817882014-12-31 11:23:31 +02001149 .fck_div_max = 64,
Laurent Pinchart9f0fbae2017-08-05 01:44:17 +03001150 .fck_freq_max = 209250000,
Tomi Valkeinen6d817882014-12-31 11:23:31 +02001151 .dss_fck_multiplier = 1,
1152 .parent_clk_name = "dpll_per_x2_ck",
Tomi Valkeinen6d817882014-12-31 11:23:31 +02001153 .ports = dra7xx_ports,
1154 .num_ports = ARRAY_SIZE(dra7xx_ports),
Laurent Pinchart51919572017-08-05 01:44:18 +03001155 .outputs = omap5_dss_supported_outputs,
Laurent Pinchartfecea252017-08-05 01:43:52 +03001156 .ops = &dss_ops_dra7,
Laurent Pinchart6d85d4a2017-08-05 01:44:07 +03001157 .dispc_clk_switch = { 9, 7 },
Laurent Pinchart4569ab72017-08-05 01:44:13 +03001158 .has_lcd_clk_src = true,
Tomi Valkeinen6d817882014-12-31 11:23:31 +02001159};
1160
Laurent Pinchart360c2152018-02-13 14:00:28 +02001161static int dss_init_ports(struct dss_device *dss)
Tomi Valkeinen2ecef242013-12-16 15:13:24 +02001162{
Laurent Pinchart360c2152018-02-13 14:00:28 +02001163 struct platform_device *pdev = dss->pdev;
Tomi Valkeinen2ecef242013-12-16 15:13:24 +02001164 struct device_node *parent = pdev->dev.of_node;
1165 struct device_node *port;
Rob Herring09bffa62017-03-22 08:26:08 -05001166 int i;
Tomi Valkeinen2ecef242013-12-16 15:13:24 +02001167
Laurent Pinchart360c2152018-02-13 14:00:28 +02001168 for (i = 0; i < dss->feat->num_ports; i++) {
Rob Herring09bffa62017-03-22 08:26:08 -05001169 port = of_graph_get_port_by_id(parent, i);
1170 if (!port)
Archit Taneja387ce9f2014-05-22 17:01:57 +05301171 continue;
1172
Laurent Pinchart360c2152018-02-13 14:00:28 +02001173 switch (dss->feat->ports[i]) {
Archit Taneja387ce9f2014-05-22 17:01:57 +05301174 case OMAP_DISPLAY_TYPE_DPI:
Laurent Pinchart360c2152018-02-13 14:00:28 +02001175 dpi_init_port(dss, pdev, port, dss->feat->model);
Archit Taneja387ce9f2014-05-22 17:01:57 +05301176 break;
1177 case OMAP_DISPLAY_TYPE_SDI:
Laurent Pinchart360c2152018-02-13 14:00:28 +02001178 sdi_init_port(dss, pdev, port);
Archit Taneja387ce9f2014-05-22 17:01:57 +05301179 break;
1180 default:
1181 break;
1182 }
Rob Herring09bffa62017-03-22 08:26:08 -05001183 }
Tomi Valkeinen2ecef242013-12-16 15:13:24 +02001184
1185 return 0;
1186}
1187
Laurent Pinchart360c2152018-02-13 14:00:28 +02001188static void dss_uninit_ports(struct dss_device *dss)
Tomi Valkeinen2ecef242013-12-16 15:13:24 +02001189{
Laurent Pinchart360c2152018-02-13 14:00:28 +02001190 struct platform_device *pdev = dss->pdev;
Archit Taneja80eb6752014-06-02 14:11:51 +05301191 struct device_node *parent = pdev->dev.of_node;
1192 struct device_node *port;
Rob Herring09bffa62017-03-22 08:26:08 -05001193 int i;
Archit Taneja80eb6752014-06-02 14:11:51 +05301194
Laurent Pinchart360c2152018-02-13 14:00:28 +02001195 for (i = 0; i < dss->feat->num_ports; i++) {
Rob Herring09bffa62017-03-22 08:26:08 -05001196 port = of_graph_get_port_by_id(parent, i);
1197 if (!port)
Archit Taneja387ce9f2014-05-22 17:01:57 +05301198 continue;
1199
Laurent Pinchart360c2152018-02-13 14:00:28 +02001200 switch (dss->feat->ports[i]) {
Archit Taneja387ce9f2014-05-22 17:01:57 +05301201 case OMAP_DISPLAY_TYPE_DPI:
1202 dpi_uninit_port(port);
1203 break;
1204 case OMAP_DISPLAY_TYPE_SDI:
1205 sdi_uninit_port(port);
1206 break;
1207 default:
1208 break;
1209 }
Rob Herring09bffa62017-03-22 08:26:08 -05001210 }
Tomi Valkeinen2ecef242013-12-16 15:13:24 +02001211}
1212
Laurent Pinchart360c2152018-02-13 14:00:28 +02001213static int dss_video_pll_probe(struct dss_device *dss)
Senthilvadivu Guruswamy96c401b2011-01-24 06:21:57 +00001214{
Laurent Pinchart360c2152018-02-13 14:00:28 +02001215 struct platform_device *pdev = dss->pdev;
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +05301216 struct device_node *np = pdev->dev.of_node;
Tomi Valkeinen99767542014-07-04 13:38:27 +05301217 struct regulator *pll_regulator;
Tomi Valkeinen7e328f52015-06-04 13:02:52 +03001218 int r;
Senthilvadivu Guruswamy96c401b2011-01-24 06:21:57 +00001219
Tomi Valkeinen7e328f52015-06-04 13:02:52 +03001220 if (!np)
1221 return 0;
Senthilvadivu Guruswamy96c401b2011-01-24 06:21:57 +00001222
Tomi Valkeinen7e328f52015-06-04 13:02:52 +03001223 if (of_property_read_bool(np, "syscon-pll-ctrl")) {
Laurent Pinchart360c2152018-02-13 14:00:28 +02001224 dss->syscon_pll_ctrl = syscon_regmap_lookup_by_phandle(np,
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +05301225 "syscon-pll-ctrl");
Laurent Pinchart360c2152018-02-13 14:00:28 +02001226 if (IS_ERR(dss->syscon_pll_ctrl)) {
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +05301227 dev_err(&pdev->dev,
1228 "failed to get syscon-pll-ctrl regmap\n");
Laurent Pinchart360c2152018-02-13 14:00:28 +02001229 return PTR_ERR(dss->syscon_pll_ctrl);
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +05301230 }
1231
1232 if (of_property_read_u32_index(np, "syscon-pll-ctrl", 1,
Laurent Pinchart360c2152018-02-13 14:00:28 +02001233 &dss->syscon_pll_ctrl_offset)) {
Tomi Valkeinenbe40eec2014-07-04 13:37:15 +05301234 dev_err(&pdev->dev,
1235 "failed to get syscon-pll-ctrl offset\n");
1236 return -EINVAL;
1237 }
1238 }
1239
Tomi Valkeinen99767542014-07-04 13:38:27 +05301240 pll_regulator = devm_regulator_get(&pdev->dev, "vdda_video");
1241 if (IS_ERR(pll_regulator)) {
1242 r = PTR_ERR(pll_regulator);
1243
1244 switch (r) {
1245 case -ENOENT:
1246 pll_regulator = NULL;
1247 break;
1248
1249 case -EPROBE_DEFER:
1250 return -EPROBE_DEFER;
1251
1252 default:
1253 DSSERR("can't get DPLL VDDA regulator\n");
1254 return r;
1255 }
1256 }
1257
1258 if (of_property_match_string(np, "reg-names", "pll1") >= 0) {
Laurent Pinchart360c2152018-02-13 14:00:28 +02001259 dss->video1_pll = dss_video_pll_init(dss, pdev, 0,
1260 pll_regulator);
1261 if (IS_ERR(dss->video1_pll))
1262 return PTR_ERR(dss->video1_pll);
Tomi Valkeinen99767542014-07-04 13:38:27 +05301263 }
1264
1265 if (of_property_match_string(np, "reg-names", "pll2") >= 0) {
Laurent Pinchart360c2152018-02-13 14:00:28 +02001266 dss->video2_pll = dss_video_pll_init(dss, pdev, 1,
1267 pll_regulator);
1268 if (IS_ERR(dss->video2_pll)) {
1269 dss_video_pll_uninit(dss->video1_pll);
1270 return PTR_ERR(dss->video2_pll);
Tomi Valkeinen99767542014-07-04 13:38:27 +05301271 }
1272 }
1273
Tomi Valkeinen7e328f52015-06-04 13:02:52 +03001274 return 0;
1275}
1276
1277/* DSS HW IP initialisation */
Laurent Pinchart18daeb82017-08-05 01:43:58 +03001278static const struct of_device_id dss_of_match[] = {
1279 { .compatible = "ti,omap2-dss", .data = &omap24xx_dss_feats },
1280 { .compatible = "ti,omap3-dss", .data = &omap3630_dss_feats },
1281 { .compatible = "ti,omap4-dss", .data = &omap44xx_dss_feats },
1282 { .compatible = "ti,omap5-dss", .data = &omap54xx_dss_feats },
1283 { .compatible = "ti,dra7-dss", .data = &dra7xx_dss_feats },
1284 {},
1285};
1286MODULE_DEVICE_TABLE(of, dss_of_match);
1287
1288static const struct soc_device_attribute dss_soc_devices[] = {
1289 { .machine = "OMAP3430/3530", .data = &omap34xx_dss_feats },
1290 { .machine = "AM35??", .data = &omap34xx_dss_feats },
1291 { .family = "AM43xx", .data = &am43xx_dss_feats },
1292 { /* sentinel */ }
1293};
1294
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001295static int dss_bind(struct device *dev)
Tomi Valkeinen7e328f52015-06-04 13:02:52 +03001296{
Tomi Valkeinen7e328f52015-06-04 13:02:52 +03001297 int r;
1298
Laurent Pinchart215003b2018-02-11 15:07:44 +02001299 r = component_bind_all(dev, NULL);
Tomi Valkeinen7e328f52015-06-04 13:02:52 +03001300 if (r)
1301 return r;
1302
Tomi Valkeinencb17a4a2015-02-25 12:08:14 +02001303 pm_set_vt_switch(0);
1304
Peter Ujfalusi1e08c822016-05-03 22:07:10 +03001305 omapdss_gather_components(dev);
Tomi Valkeinen7c299712015-11-05 17:23:14 +02001306 omapdss_set_is_initialized(true);
Tomi Valkeinenf99467b2015-06-04 12:35:42 +03001307
Senthilvadivu Guruswamy8b9cb3a2011-01-24 06:21:58 +00001308 return 0;
Senthilvadivu Guruswamy96c401b2011-01-24 06:21:57 +00001309}
1310
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001311static void dss_unbind(struct device *dev)
Senthilvadivu Guruswamy96c401b2011-01-24 06:21:57 +00001312{
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001313 struct platform_device *pdev = to_platform_device(dev);
1314
Tomi Valkeinen7c299712015-11-05 17:23:14 +02001315 omapdss_set_is_initialized(false);
Tomi Valkeinenf99467b2015-06-04 12:35:42 +03001316
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001317 component_unbind_all(&pdev->dev, NULL);
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001318}
Tomi Valkeinenb98482e2011-05-16 13:52:51 +03001319
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001320static const struct component_master_ops dss_component_ops = {
1321 .bind = dss_bind,
1322 .unbind = dss_unbind,
1323};
1324
1325static int dss_component_compare(struct device *dev, void *data)
1326{
1327 struct device *child = data;
1328 return dev == child;
1329}
1330
1331static int dss_add_child_component(struct device *dev, void *data)
1332{
1333 struct component_match **match = data;
1334
Tomi Valkeinen0438ec92015-06-30 12:23:45 +03001335 /*
1336 * HACK
1337 * We don't have a working driver for rfbi, so skip it here always.
1338 * Otherwise dss will never get probed successfully, as it will wait
1339 * for rfbi to get probed.
1340 */
1341 if (strstr(dev_name(dev), "rfbi"))
1342 return 0;
1343
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001344 component_match_add(dev->parent, match, dss_component_compare, dev);
1345
1346 return 0;
1347}
1348
Laurent Pinchart7b295252018-02-13 14:00:21 +02001349static int dss_probe_hardware(struct dss_device *dss)
Laurent Pinchart215003b2018-02-11 15:07:44 +02001350{
1351 u32 rev;
1352 int r;
1353
Laurent Pinchart7b295252018-02-13 14:00:21 +02001354 r = dss_runtime_get(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001355 if (r)
1356 return r;
1357
Laurent Pinchart7b295252018-02-13 14:00:21 +02001358 dss->dss_clk_rate = clk_get_rate(dss->dss_clk);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001359
1360 /* Select DPLL */
Laurent Pinchart360c2152018-02-13 14:00:28 +02001361 REG_FLD_MOD(dss, DSS_CONTROL, 0, 0, 0);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001362
Laurent Pinchart360c2152018-02-13 14:00:28 +02001363 dss_select_dispc_clk_source(dss, DSS_CLK_SRC_FCK);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001364
1365#ifdef CONFIG_OMAP2_DSS_VENC
Laurent Pinchart360c2152018-02-13 14:00:28 +02001366 REG_FLD_MOD(dss, DSS_CONTROL, 1, 4, 4); /* venc dac demen */
1367 REG_FLD_MOD(dss, DSS_CONTROL, 1, 3, 3); /* venc clock 4x enable */
1368 REG_FLD_MOD(dss, DSS_CONTROL, 0, 2, 2); /* venc clock mode = normal */
Laurent Pinchart215003b2018-02-11 15:07:44 +02001369#endif
Laurent Pinchart7b295252018-02-13 14:00:21 +02001370 dss->dsi_clk_source[0] = DSS_CLK_SRC_FCK;
1371 dss->dsi_clk_source[1] = DSS_CLK_SRC_FCK;
1372 dss->dispc_clk_source = DSS_CLK_SRC_FCK;
1373 dss->lcd_clk_source[0] = DSS_CLK_SRC_FCK;
1374 dss->lcd_clk_source[1] = DSS_CLK_SRC_FCK;
Laurent Pinchart215003b2018-02-11 15:07:44 +02001375
Laurent Pinchart360c2152018-02-13 14:00:28 +02001376 rev = dss_read_reg(dss, DSS_REVISION);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001377 pr_info("OMAP DSS rev %d.%d\n", FLD_GET(rev, 7, 4), FLD_GET(rev, 3, 0));
1378
Laurent Pinchart7b295252018-02-13 14:00:21 +02001379 dss_runtime_put(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001380
1381 return 0;
1382}
1383
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001384static int dss_probe(struct platform_device *pdev)
1385{
Laurent Pinchart4a9fab32017-08-05 01:44:00 +03001386 const struct soc_device_attribute *soc;
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001387 struct component_match *match = NULL;
Laurent Pinchart215003b2018-02-11 15:07:44 +02001388 struct resource *dss_mem;
Laurent Pinchart360c2152018-02-13 14:00:28 +02001389 struct dss_device *dss;
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001390 int r;
1391
Laurent Pinchart360c2152018-02-13 14:00:28 +02001392 dss = kzalloc(sizeof(*dss), GFP_KERNEL);
1393 if (!dss)
1394 return -ENOMEM;
1395
1396 dss->pdev = pdev;
1397 platform_set_drvdata(pdev, dss);
Laurent Pinchart4a9fab32017-08-05 01:44:00 +03001398
Laurent Pincharta921c1a2017-10-13 17:59:01 +03001399 r = dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32));
1400 if (r) {
1401 dev_err(&pdev->dev, "Failed to set the DMA mask\n");
Laurent Pinchart360c2152018-02-13 14:00:28 +02001402 goto err_free_dss;
Laurent Pincharta921c1a2017-10-13 17:59:01 +03001403 }
1404
Laurent Pinchart4a9fab32017-08-05 01:44:00 +03001405 /*
1406 * The various OMAP3-based SoCs can't be told apart using the compatible
1407 * string, use SoC device matching.
1408 */
1409 soc = soc_device_match(dss_soc_devices);
1410 if (soc)
Laurent Pinchart360c2152018-02-13 14:00:28 +02001411 dss->feat = soc->data;
Laurent Pinchart4a9fab32017-08-05 01:44:00 +03001412 else
Laurent Pinchart360c2152018-02-13 14:00:28 +02001413 dss->feat = of_match_device(dss_of_match, &pdev->dev)->data;
Laurent Pinchart4a9fab32017-08-05 01:44:00 +03001414
Laurent Pinchart215003b2018-02-11 15:07:44 +02001415 /* Map I/O registers, get and setup clocks. */
1416 dss_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
Laurent Pinchart360c2152018-02-13 14:00:28 +02001417 dss->base = devm_ioremap_resource(&pdev->dev, dss_mem);
1418 if (IS_ERR(dss->base)) {
1419 r = PTR_ERR(dss->base);
1420 goto err_free_dss;
1421 }
Laurent Pinchart215003b2018-02-11 15:07:44 +02001422
Laurent Pinchart360c2152018-02-13 14:00:28 +02001423 r = dss_get_clocks(dss);
Laurent Pinchart11765d12017-08-05 01:44:01 +03001424 if (r)
Laurent Pinchart360c2152018-02-13 14:00:28 +02001425 goto err_free_dss;
Laurent Pinchart11765d12017-08-05 01:44:01 +03001426
Laurent Pinchart360c2152018-02-13 14:00:28 +02001427 r = dss_setup_default_clock(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001428 if (r)
1429 goto err_put_clocks;
1430
1431 /* Setup the video PLLs and the DPI and SDI ports. */
Laurent Pinchart360c2152018-02-13 14:00:28 +02001432 r = dss_video_pll_probe(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001433 if (r)
1434 goto err_put_clocks;
1435
Laurent Pinchart360c2152018-02-13 14:00:28 +02001436 r = dss_init_ports(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001437 if (r)
1438 goto err_uninit_plls;
1439
1440 /* Enable runtime PM and probe the hardware. */
1441 pm_runtime_enable(&pdev->dev);
1442
Laurent Pinchart360c2152018-02-13 14:00:28 +02001443 r = dss_probe_hardware(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001444 if (r)
1445 goto err_pm_runtime_disable;
1446
1447 /* Initialize debugfs. */
Laurent Pinchart360c2152018-02-13 14:00:28 +02001448 r = dss_initialize_debugfs(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001449 if (r)
1450 goto err_pm_runtime_disable;
1451
1452 dss_debugfs_create_file("dss", dss_dump_regs);
1453
1454 /* Add all the child devices as components. */
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001455 device_for_each_child(&pdev->dev, &match, dss_add_child_component);
1456
1457 r = component_master_add_with_match(&pdev->dev, &dss_component_ops, match);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001458 if (r)
1459 goto err_uninit_debugfs;
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001460
1461 return 0;
Laurent Pinchart215003b2018-02-11 15:07:44 +02001462
1463err_uninit_debugfs:
1464 dss_uninitialize_debugfs();
1465
1466err_pm_runtime_disable:
1467 pm_runtime_disable(&pdev->dev);
Laurent Pinchart360c2152018-02-13 14:00:28 +02001468 dss_uninit_ports(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001469
1470err_uninit_plls:
Laurent Pinchart360c2152018-02-13 14:00:28 +02001471 if (dss->video1_pll)
1472 dss_video_pll_uninit(dss->video1_pll);
1473 if (dss->video2_pll)
1474 dss_video_pll_uninit(dss->video2_pll);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001475
1476err_put_clocks:
Laurent Pinchart360c2152018-02-13 14:00:28 +02001477 dss_put_clocks(dss);
1478
1479err_free_dss:
1480 kfree(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001481
1482 return r;
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001483}
1484
1485static int dss_remove(struct platform_device *pdev)
1486{
Laurent Pinchart360c2152018-02-13 14:00:28 +02001487 struct dss_device *dss = platform_get_drvdata(pdev);
1488
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001489 component_master_del(&pdev->dev, &dss_component_ops);
Laurent Pinchart11765d12017-08-05 01:44:01 +03001490
1491 dss_uninitialize_debugfs();
1492
Laurent Pinchart215003b2018-02-11 15:07:44 +02001493 pm_runtime_disable(&pdev->dev);
1494
Laurent Pinchart360c2152018-02-13 14:00:28 +02001495 dss_uninit_ports(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001496
Laurent Pinchart360c2152018-02-13 14:00:28 +02001497 if (dss->video1_pll)
1498 dss_video_pll_uninit(dss->video1_pll);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001499
Laurent Pinchart360c2152018-02-13 14:00:28 +02001500 if (dss->video2_pll)
1501 dss_video_pll_uninit(dss->video2_pll);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001502
Laurent Pinchart360c2152018-02-13 14:00:28 +02001503 dss_put_clocks(dss);
1504
1505 kfree(dss);
Laurent Pinchart215003b2018-02-11 15:07:44 +02001506
Senthilvadivu Guruswamy96c401b2011-01-24 06:21:57 +00001507 return 0;
1508}
1509
Laurent Pinchart74592ee2017-08-05 01:44:02 +03001510static void dss_shutdown(struct platform_device *pdev)
1511{
1512 struct omap_dss_device *dssdev = NULL;
1513
1514 DSSDBG("shutdown\n");
1515
1516 for_each_dss_dev(dssdev) {
1517 if (!dssdev->driver)
1518 continue;
1519
1520 if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE)
1521 dssdev->driver->disable(dssdev);
1522 }
1523}
1524
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +03001525static int dss_runtime_suspend(struct device *dev)
1526{
Laurent Pinchart360c2152018-02-13 14:00:28 +02001527 struct dss_device *dss = dev_get_drvdata(dev);
1528
1529 dss_save_context(dss);
Tomi Valkeinena8081d32012-03-08 12:52:38 +02001530 dss_set_min_bus_tput(dev, 0);
Dave Gerlach5038bb82014-10-31 16:28:57 -05001531
1532 pinctrl_pm_select_sleep_state(dev);
1533
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +03001534 return 0;
1535}
1536
1537static int dss_runtime_resume(struct device *dev)
1538{
Laurent Pinchart360c2152018-02-13 14:00:28 +02001539 struct dss_device *dss = dev_get_drvdata(dev);
Tomi Valkeinena8081d32012-03-08 12:52:38 +02001540 int r;
Dave Gerlach5038bb82014-10-31 16:28:57 -05001541
1542 pinctrl_pm_select_default_state(dev);
1543
Tomi Valkeinena8081d32012-03-08 12:52:38 +02001544 /*
1545 * Set an arbitrarily high tput request to ensure OPP100.
1546 * What we should really do is to make a request to stay in OPP100,
1547 * without any tput requirements, but that is not currently possible
1548 * via the PM layer.
1549 */
1550
1551 r = dss_set_min_bus_tput(dev, 1000000000);
1552 if (r)
1553 return r;
1554
Laurent Pinchart360c2152018-02-13 14:00:28 +02001555 dss_restore_context(dss);
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +03001556 return 0;
1557}
1558
1559static const struct dev_pm_ops dss_pm_ops = {
1560 .runtime_suspend = dss_runtime_suspend,
1561 .runtime_resume = dss_runtime_resume,
1562};
1563
Andrew F. Davisd66c36a2017-12-05 14:29:32 -06001564struct platform_driver omap_dsshw_driver = {
Tomi Valkeinen736e60d2015-06-04 15:22:23 +03001565 .probe = dss_probe,
1566 .remove = dss_remove,
Laurent Pinchart74592ee2017-08-05 01:44:02 +03001567 .shutdown = dss_shutdown,
Senthilvadivu Guruswamy96c401b2011-01-24 06:21:57 +00001568 .driver = {
1569 .name = "omapdss_dss",
Tomi Valkeinen4fbafaf2011-05-27 10:52:19 +03001570 .pm = &dss_pm_ops,
Tomi Valkeinen2ecef242013-12-16 15:13:24 +02001571 .of_match_table = dss_of_match,
Tomi Valkeinen422ccbd2014-10-16 09:54:25 +03001572 .suppress_bind_attrs = true,
Senthilvadivu Guruswamy96c401b2011-01-24 06:21:57 +00001573 },
1574};