1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * TI SN65DSI83,84,85 driver
4  *
5  * Currently supported:
6  * - SN65DSI83
7  *   = 1x Single-link DSI ~ 1x Single-link LVDS
8  *   - Supported
9  *   - Single-link LVDS mode tested
10  * - SN65DSI84
11  *   = 1x Single-link DSI ~ 2x Single-link or 1x Dual-link LVDS
12  *   - Supported
13  *   - Dual-link LVDS mode tested
14  *   - 2x Single-link LVDS mode unsupported
15  *     (should be easy to add by someone who has the HW)
16  * - SN65DSI85
17  *   = 2x Single-link or 1x Dual-link DSI ~ 2x Single-link or 1x Dual-link LVDS
18  *   - Unsupported
19  *     (should be easy to add by someone who has the HW)
20  *
21  * Copyright (C) 2021 Marek Vasut <marex@denx.de>
22  *
23  * Based on previous work of:
24  * Valentin Raevsky <valentin@compulab.co.il>
25  * Philippe Schenker <philippe.schenker@toradex.com>
26  */
27 
28 #include <linux/bits.h>
29 #include <linux/clk.h>
30 #include <linux/gpio/consumer.h>
31 #include <linux/i2c.h>
32 #include <linux/module.h>
33 #include <linux/of_device.h>
34 #include <linux/of_graph.h>
35 #include <linux/regmap.h>
36 #include <linux/regulator/consumer.h>
37 
38 #include <drm/drm_atomic_helper.h>
39 #include <drm/drm_bridge.h>
40 #include <drm/drm_mipi_dsi.h>
41 #include <drm/drm_of.h>
42 #include <drm/drm_panel.h>
43 #include <drm/drm_print.h>
44 #include <drm/drm_probe_helper.h>
45 
46 /* ID registers */
47 #define REG_ID(n)				(0x00 + (n))
48 /* Reset and clock registers */
49 #define REG_RC_RESET				0x09
50 #define  REG_RC_RESET_SOFT_RESET		BIT(0)
51 #define REG_RC_LVDS_PLL				0x0a
52 #define  REG_RC_LVDS_PLL_PLL_EN_STAT		BIT(7)
53 #define  REG_RC_LVDS_PLL_LVDS_CLK_RANGE(n)	(((n) & 0x7) << 1)
54 #define  REG_RC_LVDS_PLL_HS_CLK_SRC_DPHY	BIT(0)
55 #define REG_RC_DSI_CLK				0x0b
56 #define  REG_RC_DSI_CLK_DSI_CLK_DIVIDER(n)	(((n) & 0x1f) << 3)
57 #define  REG_RC_DSI_CLK_REFCLK_MULTIPLIER(n)	((n) & 0x3)
58 #define REG_RC_PLL_EN				0x0d
59 #define  REG_RC_PLL_EN_PLL_EN			BIT(0)
60 /* DSI registers */
61 #define REG_DSI_LANE				0x10
62 #define  REG_DSI_LANE_LEFT_RIGHT_PIXELS		BIT(7)	/* DSI85-only */
63 #define  REG_DSI_LANE_DSI_CHANNEL_MODE_DUAL	0	/* DSI85-only */
64 #define  REG_DSI_LANE_DSI_CHANNEL_MODE_2SINGLE	BIT(6)	/* DSI85-only */
65 #define  REG_DSI_LANE_DSI_CHANNEL_MODE_SINGLE	BIT(5)
66 #define  REG_DSI_LANE_CHA_DSI_LANES(n)		(((n) & 0x3) << 3)
67 #define  REG_DSI_LANE_CHB_DSI_LANES(n)		(((n) & 0x3) << 1)
68 #define  REG_DSI_LANE_SOT_ERR_TOL_DIS		BIT(0)
69 #define REG_DSI_EQ				0x11
70 #define  REG_DSI_EQ_CHA_DSI_DATA_EQ(n)		(((n) & 0x3) << 6)
71 #define  REG_DSI_EQ_CHA_DSI_CLK_EQ(n)		(((n) & 0x3) << 2)
72 #define REG_DSI_CLK				0x12
73 #define  REG_DSI_CLK_CHA_DSI_CLK_RANGE(n)	((n) & 0xff)
74 /* LVDS registers */
75 #define REG_LVDS_FMT				0x18
76 #define  REG_LVDS_FMT_DE_NEG_POLARITY		BIT(7)
77 #define  REG_LVDS_FMT_HS_NEG_POLARITY		BIT(6)
78 #define  REG_LVDS_FMT_VS_NEG_POLARITY		BIT(5)
79 #define  REG_LVDS_FMT_LVDS_LINK_CFG		BIT(4)	/* 0:AB 1:A-only */
80 #define  REG_LVDS_FMT_CHA_24BPP_MODE		BIT(3)
81 #define  REG_LVDS_FMT_CHB_24BPP_MODE		BIT(2)
82 #define  REG_LVDS_FMT_CHA_24BPP_FORMAT1		BIT(1)
83 #define  REG_LVDS_FMT_CHB_24BPP_FORMAT1		BIT(0)
84 #define REG_LVDS_VCOM				0x19
85 #define  REG_LVDS_VCOM_CHA_LVDS_VOCM		BIT(6)
86 #define  REG_LVDS_VCOM_CHB_LVDS_VOCM		BIT(4)
87 #define  REG_LVDS_VCOM_CHA_LVDS_VOD_SWING(n)	(((n) & 0x3) << 2)
88 #define  REG_LVDS_VCOM_CHB_LVDS_VOD_SWING(n)	((n) & 0x3)
89 #define REG_LVDS_LANE				0x1a
90 #define  REG_LVDS_LANE_EVEN_ODD_SWAP		BIT(6)
91 #define  REG_LVDS_LANE_CHA_REVERSE_LVDS		BIT(5)
92 #define  REG_LVDS_LANE_CHB_REVERSE_LVDS		BIT(4)
93 #define  REG_LVDS_LANE_CHA_LVDS_TERM		BIT(1)
94 #define  REG_LVDS_LANE_CHB_LVDS_TERM		BIT(0)
95 #define REG_LVDS_CM				0x1b
96 #define  REG_LVDS_CM_CHA_LVDS_CM_ADJUST(n)	(((n) & 0x3) << 4)
97 #define  REG_LVDS_CM_CHB_LVDS_CM_ADJUST(n)	((n) & 0x3)
98 /* Video registers */
99 #define REG_VID_CHA_ACTIVE_LINE_LENGTH_LOW	0x20
100 #define REG_VID_CHA_ACTIVE_LINE_LENGTH_HIGH	0x21
101 #define REG_VID_CHA_VERTICAL_DISPLAY_SIZE_LOW	0x24
102 #define REG_VID_CHA_VERTICAL_DISPLAY_SIZE_HIGH	0x25
103 #define REG_VID_CHA_SYNC_DELAY_LOW		0x28
104 #define REG_VID_CHA_SYNC_DELAY_HIGH		0x29
105 #define REG_VID_CHA_HSYNC_PULSE_WIDTH_LOW	0x2c
106 #define REG_VID_CHA_HSYNC_PULSE_WIDTH_HIGH	0x2d
107 #define REG_VID_CHA_VSYNC_PULSE_WIDTH_LOW	0x30
108 #define REG_VID_CHA_VSYNC_PULSE_WIDTH_HIGH	0x31
109 #define REG_VID_CHA_HORIZONTAL_BACK_PORCH	0x34
110 #define REG_VID_CHA_VERTICAL_BACK_PORCH		0x36
111 #define REG_VID_CHA_HORIZONTAL_FRONT_PORCH	0x38
112 #define REG_VID_CHA_VERTICAL_FRONT_PORCH	0x3a
113 #define REG_VID_CHA_TEST_PATTERN		0x3c
114 /* IRQ registers */
115 #define REG_IRQ_GLOBAL				0xe0
116 #define  REG_IRQ_GLOBAL_IRQ_EN			BIT(0)
117 #define REG_IRQ_EN				0xe1
118 #define  REG_IRQ_EN_CHA_SYNCH_ERR_EN		BIT(7)
119 #define  REG_IRQ_EN_CHA_CRC_ERR_EN		BIT(6)
120 #define  REG_IRQ_EN_CHA_UNC_ECC_ERR_EN		BIT(5)
121 #define  REG_IRQ_EN_CHA_COR_ECC_ERR_EN		BIT(4)
122 #define  REG_IRQ_EN_CHA_LLP_ERR_EN		BIT(3)
123 #define  REG_IRQ_EN_CHA_SOT_BIT_ERR_EN		BIT(2)
124 #define  REG_IRQ_EN_CHA_PLL_UNLOCK_EN		BIT(0)
125 #define REG_IRQ_STAT				0xe5
126 #define  REG_IRQ_STAT_CHA_SYNCH_ERR		BIT(7)
127 #define  REG_IRQ_STAT_CHA_CRC_ERR		BIT(6)
128 #define  REG_IRQ_STAT_CHA_UNC_ECC_ERR		BIT(5)
129 #define  REG_IRQ_STAT_CHA_COR_ECC_ERR		BIT(4)
130 #define  REG_IRQ_STAT_CHA_LLP_ERR		BIT(3)
131 #define  REG_IRQ_STAT_CHA_SOT_BIT_ERR		BIT(2)
132 #define  REG_IRQ_STAT_CHA_PLL_UNLOCK		BIT(0)
133 
134 enum sn65dsi83_model {
135 	MODEL_SN65DSI83,
136 	MODEL_SN65DSI84,
137 };
138 
139 struct sn65dsi83 {
140 	struct drm_bridge		bridge;
141 	struct device			*dev;
142 	struct regmap			*regmap;
143 	struct device_node		*host_node;
144 	struct mipi_dsi_device		*dsi;
145 	struct drm_bridge		*panel_bridge;
146 	struct gpio_desc		*enable_gpio;
147 	struct regulator		*vcc;
148 	int				dsi_lanes;
149 	bool				lvds_dual_link;
150 	bool				lvds_dual_link_even_odd_swap;
151 };
152 
153 static const struct regmap_range sn65dsi83_readable_ranges[] = {
154 	regmap_reg_range(REG_ID(0), REG_ID(8)),
155 	regmap_reg_range(REG_RC_LVDS_PLL, REG_RC_DSI_CLK),
156 	regmap_reg_range(REG_RC_PLL_EN, REG_RC_PLL_EN),
157 	regmap_reg_range(REG_DSI_LANE, REG_DSI_CLK),
158 	regmap_reg_range(REG_LVDS_FMT, REG_LVDS_CM),
159 	regmap_reg_range(REG_VID_CHA_ACTIVE_LINE_LENGTH_LOW,
160 			 REG_VID_CHA_ACTIVE_LINE_LENGTH_HIGH),
161 	regmap_reg_range(REG_VID_CHA_VERTICAL_DISPLAY_SIZE_LOW,
162 			 REG_VID_CHA_VERTICAL_DISPLAY_SIZE_HIGH),
163 	regmap_reg_range(REG_VID_CHA_SYNC_DELAY_LOW,
164 			 REG_VID_CHA_SYNC_DELAY_HIGH),
165 	regmap_reg_range(REG_VID_CHA_HSYNC_PULSE_WIDTH_LOW,
166 			 REG_VID_CHA_HSYNC_PULSE_WIDTH_HIGH),
167 	regmap_reg_range(REG_VID_CHA_VSYNC_PULSE_WIDTH_LOW,
168 			 REG_VID_CHA_VSYNC_PULSE_WIDTH_HIGH),
169 	regmap_reg_range(REG_VID_CHA_HORIZONTAL_BACK_PORCH,
170 			 REG_VID_CHA_HORIZONTAL_BACK_PORCH),
171 	regmap_reg_range(REG_VID_CHA_VERTICAL_BACK_PORCH,
172 			 REG_VID_CHA_VERTICAL_BACK_PORCH),
173 	regmap_reg_range(REG_VID_CHA_HORIZONTAL_FRONT_PORCH,
174 			 REG_VID_CHA_HORIZONTAL_FRONT_PORCH),
175 	regmap_reg_range(REG_VID_CHA_VERTICAL_FRONT_PORCH,
176 			 REG_VID_CHA_VERTICAL_FRONT_PORCH),
177 	regmap_reg_range(REG_VID_CHA_TEST_PATTERN, REG_VID_CHA_TEST_PATTERN),
178 	regmap_reg_range(REG_IRQ_GLOBAL, REG_IRQ_EN),
179 	regmap_reg_range(REG_IRQ_STAT, REG_IRQ_STAT),
180 };
181 
182 static const struct regmap_access_table sn65dsi83_readable_table = {
183 	.yes_ranges = sn65dsi83_readable_ranges,
184 	.n_yes_ranges = ARRAY_SIZE(sn65dsi83_readable_ranges),
185 };
186 
187 static const struct regmap_range sn65dsi83_writeable_ranges[] = {
188 	regmap_reg_range(REG_RC_RESET, REG_RC_DSI_CLK),
189 	regmap_reg_range(REG_RC_PLL_EN, REG_RC_PLL_EN),
190 	regmap_reg_range(REG_DSI_LANE, REG_DSI_CLK),
191 	regmap_reg_range(REG_LVDS_FMT, REG_LVDS_CM),
192 	regmap_reg_range(REG_VID_CHA_ACTIVE_LINE_LENGTH_LOW,
193 			 REG_VID_CHA_ACTIVE_LINE_LENGTH_HIGH),
194 	regmap_reg_range(REG_VID_CHA_VERTICAL_DISPLAY_SIZE_LOW,
195 			 REG_VID_CHA_VERTICAL_DISPLAY_SIZE_HIGH),
196 	regmap_reg_range(REG_VID_CHA_SYNC_DELAY_LOW,
197 			 REG_VID_CHA_SYNC_DELAY_HIGH),
198 	regmap_reg_range(REG_VID_CHA_HSYNC_PULSE_WIDTH_LOW,
199 			 REG_VID_CHA_HSYNC_PULSE_WIDTH_HIGH),
200 	regmap_reg_range(REG_VID_CHA_VSYNC_PULSE_WIDTH_LOW,
201 			 REG_VID_CHA_VSYNC_PULSE_WIDTH_HIGH),
202 	regmap_reg_range(REG_VID_CHA_HORIZONTAL_BACK_PORCH,
203 			 REG_VID_CHA_HORIZONTAL_BACK_PORCH),
204 	regmap_reg_range(REG_VID_CHA_VERTICAL_BACK_PORCH,
205 			 REG_VID_CHA_VERTICAL_BACK_PORCH),
206 	regmap_reg_range(REG_VID_CHA_HORIZONTAL_FRONT_PORCH,
207 			 REG_VID_CHA_HORIZONTAL_FRONT_PORCH),
208 	regmap_reg_range(REG_VID_CHA_VERTICAL_FRONT_PORCH,
209 			 REG_VID_CHA_VERTICAL_FRONT_PORCH),
210 	regmap_reg_range(REG_VID_CHA_TEST_PATTERN, REG_VID_CHA_TEST_PATTERN),
211 	regmap_reg_range(REG_IRQ_GLOBAL, REG_IRQ_EN),
212 	regmap_reg_range(REG_IRQ_STAT, REG_IRQ_STAT),
213 };
214 
215 static const struct regmap_access_table sn65dsi83_writeable_table = {
216 	.yes_ranges = sn65dsi83_writeable_ranges,
217 	.n_yes_ranges = ARRAY_SIZE(sn65dsi83_writeable_ranges),
218 };
219 
220 static const struct regmap_range sn65dsi83_volatile_ranges[] = {
221 	regmap_reg_range(REG_RC_RESET, REG_RC_RESET),
222 	regmap_reg_range(REG_RC_LVDS_PLL, REG_RC_LVDS_PLL),
223 	regmap_reg_range(REG_IRQ_STAT, REG_IRQ_STAT),
224 };
225 
226 static const struct regmap_access_table sn65dsi83_volatile_table = {
227 	.yes_ranges = sn65dsi83_volatile_ranges,
228 	.n_yes_ranges = ARRAY_SIZE(sn65dsi83_volatile_ranges),
229 };
230 
231 static const struct regmap_config sn65dsi83_regmap_config = {
232 	.reg_bits = 8,
233 	.val_bits = 8,
234 	.rd_table = &sn65dsi83_readable_table,
235 	.wr_table = &sn65dsi83_writeable_table,
236 	.volatile_table = &sn65dsi83_volatile_table,
237 	.cache_type = REGCACHE_RBTREE,
238 	.max_register = REG_IRQ_STAT,
239 };
240 
241 static struct sn65dsi83 *bridge_to_sn65dsi83(struct drm_bridge *bridge)
242 {
243 	return container_of(bridge, struct sn65dsi83, bridge);
244 }
245 
246 static int sn65dsi83_attach(struct drm_bridge *bridge,
247 			    enum drm_bridge_attach_flags flags)
248 {
249 	struct sn65dsi83 *ctx = bridge_to_sn65dsi83(bridge);
250 
251 	return drm_bridge_attach(bridge->encoder, ctx->panel_bridge,
252 				 &ctx->bridge, flags);
253 }
254 
255 static void sn65dsi83_detach(struct drm_bridge *bridge)
256 {
257 	struct sn65dsi83 *ctx = bridge_to_sn65dsi83(bridge);
258 
259 	if (!ctx->dsi)
260 		return;
261 
262 	ctx->dsi = NULL;
263 }
264 
265 static u8 sn65dsi83_get_lvds_range(struct sn65dsi83 *ctx,
266 				   const struct drm_display_mode *mode)
267 {
268 	/*
269 	 * The encoding of the LVDS_CLK_RANGE is as follows:
270 	 * 000 - 25 MHz <= LVDS_CLK < 37.5 MHz
271 	 * 001 - 37.5 MHz <= LVDS_CLK < 62.5 MHz
272 	 * 010 - 62.5 MHz <= LVDS_CLK < 87.5 MHz
273 	 * 011 - 87.5 MHz <= LVDS_CLK < 112.5 MHz
274 	 * 100 - 112.5 MHz <= LVDS_CLK < 137.5 MHz
275 	 * 101 - 137.5 MHz <= LVDS_CLK <= 154 MHz
276 	 * which is a range of 12.5MHz..162.5MHz in 50MHz steps, except that
277 	 * the ends of the ranges are clamped to the supported range. Since
278 	 * sn65dsi83_mode_valid() already filters the valid modes and limits
279 	 * the clock to 25..154 MHz, the range calculation can be simplified
280 	 * as follows:
281 	 */
282 	int mode_clock = mode->clock;
283 
284 	if (ctx->lvds_dual_link)
285 		mode_clock /= 2;
286 
287 	return (mode_clock - 12500) / 25000;
288 }
289 
290 static u8 sn65dsi83_get_dsi_range(struct sn65dsi83 *ctx,
291 				  const struct drm_display_mode *mode)
292 {
293 	/*
294 	 * The encoding of the CHA_DSI_CLK_RANGE is as follows:
295 	 * 0x00 through 0x07 - Reserved
296 	 * 0x08 - 40 <= DSI_CLK < 45 MHz
297 	 * 0x09 - 45 <= DSI_CLK < 50 MHz
298 	 * ...
299 	 * 0x63 - 495 <= DSI_CLK < 500 MHz
300 	 * 0x64 - 500 MHz
301 	 * 0x65 through 0xFF - Reserved
302 	 * which is DSI clock in 5 MHz steps, clamped to 40..500 MHz.
303 	 * The DSI clock are calculated as:
304 	 *  DSI_CLK = mode clock * bpp / dsi_data_lanes / 2
305 	 * the 2 is there because the bus is DDR.
306 	 */
307 	return DIV_ROUND_UP(clamp((unsigned int)mode->clock *
308 			    mipi_dsi_pixel_format_to_bpp(ctx->dsi->format) /
309 			    ctx->dsi_lanes / 2, 40000U, 500000U), 5000U);
310 }
311 
312 static u8 sn65dsi83_get_dsi_div(struct sn65dsi83 *ctx)
313 {
314 	/* The divider is (DSI_CLK / LVDS_CLK) - 1, which really is: */
315 	unsigned int dsi_div = mipi_dsi_pixel_format_to_bpp(ctx->dsi->format);
316 
317 	dsi_div /= ctx->dsi_lanes;
318 
319 	if (!ctx->lvds_dual_link)
320 		dsi_div /= 2;
321 
322 	return dsi_div - 1;
323 }
324 
325 static void sn65dsi83_atomic_enable(struct drm_bridge *bridge,
326 				    struct drm_bridge_state *old_bridge_state)
327 {
328 	struct sn65dsi83 *ctx = bridge_to_sn65dsi83(bridge);
329 	struct drm_atomic_state *state = old_bridge_state->base.state;
330 	const struct drm_bridge_state *bridge_state;
331 	const struct drm_crtc_state *crtc_state;
332 	const struct drm_display_mode *mode;
333 	struct drm_connector *connector;
334 	struct drm_crtc *crtc;
335 	bool lvds_format_24bpp;
336 	bool lvds_format_jeida;
337 	unsigned int pval;
338 	__le16 le16val;
339 	u16 val;
340 	int ret;
341 
342 	ret = regulator_enable(ctx->vcc);
343 	if (ret) {
344 		dev_err(ctx->dev, "Failed to enable vcc: %d\n", ret);
345 		return;
346 	}
347 
348 	/* Deassert reset */
349 	gpiod_set_value(ctx->enable_gpio, 1);
350 	usleep_range(1000, 1100);
351 
352 	/* Get the LVDS format from the bridge state. */
353 	bridge_state = drm_atomic_get_new_bridge_state(state, bridge);
354 
355 	switch (bridge_state->output_bus_cfg.format) {
356 	case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG:
357 		lvds_format_24bpp = false;
358 		lvds_format_jeida = true;
359 		break;
360 	case MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA:
361 		lvds_format_24bpp = true;
362 		lvds_format_jeida = true;
363 		break;
364 	case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG:
365 		lvds_format_24bpp = true;
366 		lvds_format_jeida = false;
367 		break;
368 	default:
369 		/*
370 		 * Some bridges still don't set the correct
371 		 * LVDS bus pixel format, use SPWG24 default
372 		 * format until those are fixed.
373 		 */
374 		lvds_format_24bpp = true;
375 		lvds_format_jeida = false;
376 		dev_warn(ctx->dev,
377 			 "Unsupported LVDS bus format 0x%04x, please check output bridge driver. Falling back to SPWG24.\n",
378 			 bridge_state->output_bus_cfg.format);
379 		break;
380 	}
381 
382 	/*
383 	 * Retrieve the CRTC adjusted mode. This requires a little dance to go
384 	 * from the bridge to the encoder, to the connector and to the CRTC.
385 	 */
386 	connector = drm_atomic_get_new_connector_for_encoder(state,
387 							     bridge->encoder);
388 	crtc = drm_atomic_get_new_connector_state(state, connector)->crtc;
389 	crtc_state = drm_atomic_get_new_crtc_state(state, crtc);
390 	mode = &crtc_state->adjusted_mode;
391 
392 	/* Clear reset, disable PLL */
393 	regmap_write(ctx->regmap, REG_RC_RESET, 0x00);
394 	regmap_write(ctx->regmap, REG_RC_PLL_EN, 0x00);
395 
396 	/* Reference clock derived from DSI link clock. */
397 	regmap_write(ctx->regmap, REG_RC_LVDS_PLL,
398 		     REG_RC_LVDS_PLL_LVDS_CLK_RANGE(sn65dsi83_get_lvds_range(ctx, mode)) |
399 		     REG_RC_LVDS_PLL_HS_CLK_SRC_DPHY);
400 	regmap_write(ctx->regmap, REG_DSI_CLK,
401 		     REG_DSI_CLK_CHA_DSI_CLK_RANGE(sn65dsi83_get_dsi_range(ctx, mode)));
402 	regmap_write(ctx->regmap, REG_RC_DSI_CLK,
403 		     REG_RC_DSI_CLK_DSI_CLK_DIVIDER(sn65dsi83_get_dsi_div(ctx)));
404 
405 	/* Set number of DSI lanes and LVDS link config. */
406 	regmap_write(ctx->regmap, REG_DSI_LANE,
407 		     REG_DSI_LANE_DSI_CHANNEL_MODE_SINGLE |
408 		     REG_DSI_LANE_CHA_DSI_LANES(~(ctx->dsi_lanes - 1)) |
409 		     /* CHB is DSI85-only, set to default on DSI83/DSI84 */
410 		     REG_DSI_LANE_CHB_DSI_LANES(3));
411 	/* No equalization. */
412 	regmap_write(ctx->regmap, REG_DSI_EQ, 0x00);
413 
414 	/* Set up sync signal polarity. */
415 	val = (mode->flags & DRM_MODE_FLAG_NHSYNC ?
416 	       REG_LVDS_FMT_HS_NEG_POLARITY : 0) |
417 	      (mode->flags & DRM_MODE_FLAG_NVSYNC ?
418 	       REG_LVDS_FMT_VS_NEG_POLARITY : 0);
419 
420 	/* Set up bits-per-pixel, 18bpp or 24bpp. */
421 	if (lvds_format_24bpp) {
422 		val |= REG_LVDS_FMT_CHA_24BPP_MODE;
423 		if (ctx->lvds_dual_link)
424 			val |= REG_LVDS_FMT_CHB_24BPP_MODE;
425 	}
426 
427 	/* Set up LVDS format, JEIDA/Format 1 or SPWG/Format 2 */
428 	if (lvds_format_jeida) {
429 		val |= REG_LVDS_FMT_CHA_24BPP_FORMAT1;
430 		if (ctx->lvds_dual_link)
431 			val |= REG_LVDS_FMT_CHB_24BPP_FORMAT1;
432 	}
433 
434 	/* Set up LVDS output config (DSI84,DSI85) */
435 	if (!ctx->lvds_dual_link)
436 		val |= REG_LVDS_FMT_LVDS_LINK_CFG;
437 
438 	regmap_write(ctx->regmap, REG_LVDS_FMT, val);
439 	regmap_write(ctx->regmap, REG_LVDS_VCOM, 0x05);
440 	regmap_write(ctx->regmap, REG_LVDS_LANE,
441 		     (ctx->lvds_dual_link_even_odd_swap ?
442 		      REG_LVDS_LANE_EVEN_ODD_SWAP : 0) |
443 		     REG_LVDS_LANE_CHA_LVDS_TERM |
444 		     REG_LVDS_LANE_CHB_LVDS_TERM);
445 	regmap_write(ctx->regmap, REG_LVDS_CM, 0x00);
446 
447 	le16val = cpu_to_le16(mode->hdisplay);
448 	regmap_bulk_write(ctx->regmap, REG_VID_CHA_ACTIVE_LINE_LENGTH_LOW,
449 			  &le16val, 2);
450 	le16val = cpu_to_le16(mode->vdisplay);
451 	regmap_bulk_write(ctx->regmap, REG_VID_CHA_VERTICAL_DISPLAY_SIZE_LOW,
452 			  &le16val, 2);
453 	/* 32 + 1 pixel clock to ensure proper operation */
454 	le16val = cpu_to_le16(32 + 1);
455 	regmap_bulk_write(ctx->regmap, REG_VID_CHA_SYNC_DELAY_LOW, &le16val, 2);
456 	le16val = cpu_to_le16(mode->hsync_end - mode->hsync_start);
457 	regmap_bulk_write(ctx->regmap, REG_VID_CHA_HSYNC_PULSE_WIDTH_LOW,
458 			  &le16val, 2);
459 	le16val = cpu_to_le16(mode->vsync_end - mode->vsync_start);
460 	regmap_bulk_write(ctx->regmap, REG_VID_CHA_VSYNC_PULSE_WIDTH_LOW,
461 			  &le16val, 2);
462 	regmap_write(ctx->regmap, REG_VID_CHA_HORIZONTAL_BACK_PORCH,
463 		     mode->htotal - mode->hsync_end);
464 	regmap_write(ctx->regmap, REG_VID_CHA_VERTICAL_BACK_PORCH,
465 		     mode->vtotal - mode->vsync_end);
466 	regmap_write(ctx->regmap, REG_VID_CHA_HORIZONTAL_FRONT_PORCH,
467 		     mode->hsync_start - mode->hdisplay);
468 	regmap_write(ctx->regmap, REG_VID_CHA_VERTICAL_FRONT_PORCH,
469 		     mode->vsync_start - mode->vdisplay);
470 	regmap_write(ctx->regmap, REG_VID_CHA_TEST_PATTERN, 0x00);
471 
472 	/* Enable PLL */
473 	regmap_write(ctx->regmap, REG_RC_PLL_EN, REG_RC_PLL_EN_PLL_EN);
474 	usleep_range(3000, 4000);
475 	ret = regmap_read_poll_timeout(ctx->regmap, REG_RC_LVDS_PLL, pval,
476 				       pval & REG_RC_LVDS_PLL_PLL_EN_STAT,
477 				       1000, 100000);
478 	if (ret) {
479 		dev_err(ctx->dev, "failed to lock PLL, ret=%i\n", ret);
480 		/* On failure, disable PLL again and exit. */
481 		regmap_write(ctx->regmap, REG_RC_PLL_EN, 0x00);
482 		return;
483 	}
484 
485 	/* Trigger reset after CSR register update. */
486 	regmap_write(ctx->regmap, REG_RC_RESET, REG_RC_RESET_SOFT_RESET);
487 
488 	/* Clear all errors that got asserted during initialization. */
489 	regmap_read(ctx->regmap, REG_IRQ_STAT, &pval);
490 	regmap_write(ctx->regmap, REG_IRQ_STAT, pval);
491 }
492 
493 static void sn65dsi83_atomic_disable(struct drm_bridge *bridge,
494 				     struct drm_bridge_state *old_bridge_state)
495 {
496 	struct sn65dsi83 *ctx = bridge_to_sn65dsi83(bridge);
497 	int ret;
498 
499 	/* Put the chip in reset, pull EN line low, and assure 10ms reset low timing. */
500 	gpiod_set_value(ctx->enable_gpio, 0);
501 	usleep_range(10000, 11000);
502 
503 	ret = regulator_disable(ctx->vcc);
504 	if (ret)
505 		dev_err(ctx->dev, "Failed to disable vcc: %d\n", ret);
506 
507 	regcache_mark_dirty(ctx->regmap);
508 }
509 
510 static enum drm_mode_status
511 sn65dsi83_mode_valid(struct drm_bridge *bridge,
512 		     const struct drm_display_info *info,
513 		     const struct drm_display_mode *mode)
514 {
515 	/* LVDS output clock range 25..154 MHz */
516 	if (mode->clock < 25000)
517 		return MODE_CLOCK_LOW;
518 	if (mode->clock > 154000)
519 		return MODE_CLOCK_HIGH;
520 
521 	return MODE_OK;
522 }
523 
524 #define MAX_INPUT_SEL_FORMATS	1
525 
526 static u32 *
527 sn65dsi83_atomic_get_input_bus_fmts(struct drm_bridge *bridge,
528 				    struct drm_bridge_state *bridge_state,
529 				    struct drm_crtc_state *crtc_state,
530 				    struct drm_connector_state *conn_state,
531 				    u32 output_fmt,
532 				    unsigned int *num_input_fmts)
533 {
534 	u32 *input_fmts;
535 
536 	*num_input_fmts = 0;
537 
538 	input_fmts = kcalloc(MAX_INPUT_SEL_FORMATS, sizeof(*input_fmts),
539 			     GFP_KERNEL);
540 	if (!input_fmts)
541 		return NULL;
542 
543 	/* This is the DSI-end bus format */
544 	input_fmts[0] = MEDIA_BUS_FMT_RGB888_1X24;
545 	*num_input_fmts = 1;
546 
547 	return input_fmts;
548 }
549 
550 static const struct drm_bridge_funcs sn65dsi83_funcs = {
551 	.attach			= sn65dsi83_attach,
552 	.detach			= sn65dsi83_detach,
553 	.atomic_enable		= sn65dsi83_atomic_enable,
554 	.atomic_disable		= sn65dsi83_atomic_disable,
555 	.mode_valid		= sn65dsi83_mode_valid,
556 
557 	.atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
558 	.atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
559 	.atomic_reset = drm_atomic_helper_bridge_reset,
560 	.atomic_get_input_bus_fmts = sn65dsi83_atomic_get_input_bus_fmts,
561 };
562 
563 static int sn65dsi83_parse_dt(struct sn65dsi83 *ctx, enum sn65dsi83_model model)
564 {
565 	struct drm_bridge *panel_bridge;
566 	struct device *dev = ctx->dev;
567 	struct device_node *endpoint;
568 	struct drm_panel *panel;
569 	int ret;
570 
571 	endpoint = of_graph_get_endpoint_by_regs(dev->of_node, 0, 0);
572 	ctx->dsi_lanes = of_property_count_u32_elems(endpoint, "data-lanes");
573 	ctx->host_node = of_graph_get_remote_port_parent(endpoint);
574 	of_node_put(endpoint);
575 
576 	if (ctx->dsi_lanes < 0 || ctx->dsi_lanes > 4) {
577 		ret = -EINVAL;
578 		goto err_put_node;
579 	}
580 	if (!ctx->host_node) {
581 		ret = -ENODEV;
582 		goto err_put_node;
583 	}
584 
585 	ctx->lvds_dual_link = false;
586 	ctx->lvds_dual_link_even_odd_swap = false;
587 	if (model != MODEL_SN65DSI83) {
588 		struct device_node *port2, *port3;
589 		int dual_link;
590 
591 		port2 = of_graph_get_port_by_id(dev->of_node, 2);
592 		port3 = of_graph_get_port_by_id(dev->of_node, 3);
593 		dual_link = drm_of_lvds_get_dual_link_pixel_order(port2, port3);
594 		of_node_put(port2);
595 		of_node_put(port3);
596 
597 		if (dual_link == DRM_LVDS_DUAL_LINK_ODD_EVEN_PIXELS) {
598 			ctx->lvds_dual_link = true;
599 			/* Odd pixels to LVDS Channel A, even pixels to B */
600 			ctx->lvds_dual_link_even_odd_swap = false;
601 		} else if (dual_link == DRM_LVDS_DUAL_LINK_EVEN_ODD_PIXELS) {
602 			ctx->lvds_dual_link = true;
603 			/* Even pixels to LVDS Channel A, odd pixels to B */
604 			ctx->lvds_dual_link_even_odd_swap = true;
605 		}
606 	}
607 
608 	ret = drm_of_find_panel_or_bridge(dev->of_node, 2, 0, &panel, &panel_bridge);
609 	if (ret < 0)
610 		goto err_put_node;
611 	if (panel) {
612 		panel_bridge = devm_drm_panel_bridge_add(dev, panel);
613 		if (IS_ERR(panel_bridge)) {
614 			ret = PTR_ERR(panel_bridge);
615 			goto err_put_node;
616 		}
617 	}
618 
619 	ctx->panel_bridge = panel_bridge;
620 
621 	ctx->vcc = devm_regulator_get(dev, "vcc");
622 	if (IS_ERR(ctx->vcc))
623 		return dev_err_probe(dev, PTR_ERR(ctx->vcc),
624 				     "Failed to get supply 'vcc'\n");
625 
626 	return 0;
627 
628 err_put_node:
629 	of_node_put(ctx->host_node);
630 	return ret;
631 }
632 
633 static int sn65dsi83_host_attach(struct sn65dsi83 *ctx)
634 {
635 	struct device *dev = ctx->dev;
636 	struct mipi_dsi_device *dsi;
637 	struct mipi_dsi_host *host;
638 	const struct mipi_dsi_device_info info = {
639 		.type = "sn65dsi83",
640 		.channel = 0,
641 		.node = NULL,
642 	};
643 	int ret;
644 
645 	host = of_find_mipi_dsi_host_by_node(ctx->host_node);
646 	if (!host) {
647 		dev_err(dev, "failed to find dsi host\n");
648 		return -EPROBE_DEFER;
649 	}
650 
651 	dsi = devm_mipi_dsi_device_register_full(dev, host, &info);
652 	if (IS_ERR(dsi))
653 		return dev_err_probe(dev, PTR_ERR(dsi),
654 				     "failed to create dsi device\n");
655 
656 	ctx->dsi = dsi;
657 
658 	dsi->lanes = ctx->dsi_lanes;
659 	dsi->format = MIPI_DSI_FMT_RGB888;
660 	dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_BURST;
661 
662 	ret = devm_mipi_dsi_attach(dev, dsi);
663 	if (ret < 0) {
664 		dev_err(dev, "failed to attach dsi to host: %d\n", ret);
665 		return ret;
666 	}
667 
668 	return 0;
669 }
670 
671 static int sn65dsi83_probe(struct i2c_client *client,
672 			   const struct i2c_device_id *id)
673 {
674 	struct device *dev = &client->dev;
675 	enum sn65dsi83_model model;
676 	struct sn65dsi83 *ctx;
677 	int ret;
678 
679 	ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
680 	if (!ctx)
681 		return -ENOMEM;
682 
683 	ctx->dev = dev;
684 
685 	if (dev->of_node) {
686 		model = (enum sn65dsi83_model)(uintptr_t)
687 			of_device_get_match_data(dev);
688 	} else {
689 		model = id->driver_data;
690 	}
691 
692 	/* Put the chip in reset, pull EN line low, and assure 10ms reset low timing. */
693 	ctx->enable_gpio = devm_gpiod_get_optional(ctx->dev, "enable",
694 						   GPIOD_OUT_LOW);
695 	if (IS_ERR(ctx->enable_gpio))
696 		return PTR_ERR(ctx->enable_gpio);
697 
698 	usleep_range(10000, 11000);
699 
700 	ret = sn65dsi83_parse_dt(ctx, model);
701 	if (ret)
702 		return ret;
703 
704 	ctx->regmap = devm_regmap_init_i2c(client, &sn65dsi83_regmap_config);
705 	if (IS_ERR(ctx->regmap)) {
706 		ret = PTR_ERR(ctx->regmap);
707 		goto err_put_node;
708 	}
709 
710 	dev_set_drvdata(dev, ctx);
711 	i2c_set_clientdata(client, ctx);
712 
713 	ctx->bridge.funcs = &sn65dsi83_funcs;
714 	ctx->bridge.of_node = dev->of_node;
715 	drm_bridge_add(&ctx->bridge);
716 
717 	ret = sn65dsi83_host_attach(ctx);
718 	if (ret)
719 		goto err_remove_bridge;
720 
721 	return 0;
722 
723 err_remove_bridge:
724 	drm_bridge_remove(&ctx->bridge);
725 err_put_node:
726 	of_node_put(ctx->host_node);
727 	return ret;
728 }
729 
730 static int sn65dsi83_remove(struct i2c_client *client)
731 {
732 	struct sn65dsi83 *ctx = i2c_get_clientdata(client);
733 
734 	drm_bridge_remove(&ctx->bridge);
735 	of_node_put(ctx->host_node);
736 
737 	return 0;
738 }
739 
740 static struct i2c_device_id sn65dsi83_id[] = {
741 	{ "ti,sn65dsi83", MODEL_SN65DSI83 },
742 	{ "ti,sn65dsi84", MODEL_SN65DSI84 },
743 	{},
744 };
745 MODULE_DEVICE_TABLE(i2c, sn65dsi83_id);
746 
747 static const struct of_device_id sn65dsi83_match_table[] = {
748 	{ .compatible = "ti,sn65dsi83", .data = (void *)MODEL_SN65DSI83 },
749 	{ .compatible = "ti,sn65dsi84", .data = (void *)MODEL_SN65DSI84 },
750 	{},
751 };
752 MODULE_DEVICE_TABLE(of, sn65dsi83_match_table);
753 
754 static struct i2c_driver sn65dsi83_driver = {
755 	.probe = sn65dsi83_probe,
756 	.remove = sn65dsi83_remove,
757 	.id_table = sn65dsi83_id,
758 	.driver = {
759 		.name = "sn65dsi83",
760 		.of_match_table = sn65dsi83_match_table,
761 	},
762 };
763 module_i2c_driver(sn65dsi83_driver);
764 
765 MODULE_AUTHOR("Marek Vasut <marex@denx.de>");
766 MODULE_DESCRIPTION("TI SN65DSI83 DSI to LVDS bridge driver");
767 MODULE_LICENSE("GPL v2");
768