1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
4 * Author:
5 * Mark Yao <mark.yao@rock-chips.com>
6 * Sandy Huang <hjc@rock-chips.com>
7 */
8
9 #include <linux/component.h>
10 #include <linux/mfd/syscon.h>
11 #include <linux/of_graph.h>
12 #include <linux/phy/phy.h>
13 #include <linux/of_platform.h>
14 #include <linux/regmap.h>
15 #include <drm/drm_atomic_helper.h>
16 #include <drm/drm_bridge.h>
17 #include <drm/drm_of.h>
18 #include <drm/drm_panel.h>
19 #include <drm/drm_probe_helper.h>
20 #include <drm/drm_simple_kms_helper.h>
21
22 #include <uapi/linux/videodev2.h>
23
24 #include "rockchip_drm_drv.h"
25 #include "rockchip_drm_vop.h"
26
27 #define HIWORD_UPDATE(v, h, l) (((v) << (l)) | (GENMASK(h, l) << 16))
28
29 #define PX30_GRF_PD_VO_CON1 0x0438
30 #define PX30_LVDS_SELECT(x) HIWORD_UPDATE(x, 14, 13)
31 #define PX30_LVDS_MODE_EN(x) HIWORD_UPDATE(x, 12, 12)
32 #define PX30_LVDS_MSBSEL(x) HIWORD_UPDATE(x, 11, 11)
33 #define PX30_LVDS_P2S_EN(x) HIWORD_UPDATE(x, 6, 6)
34 #define PX30_LVDS_VOP_SEL(x) HIWORD_UPDATE(x, 1, 1)
35
36 #define RK3126_GRF_LVDS_CON0 0x0150
37 #define RK3126_LVDS_P2S_EN(x) HIWORD_UPDATE(x, 9, 9)
38 #define RK3126_LVDS_MODE_EN(x) HIWORD_UPDATE(x, 6, 6)
39 #define RK3126_LVDS_MSBSEL(x) HIWORD_UPDATE(x, 3, 3)
40 #define RK3126_LVDS_SELECT(x) HIWORD_UPDATE(x, 2, 1)
41
42 #define RK3288_GRF_SOC_CON6 0x025c
43 #define RK3288_LVDS_LCDC_SEL(x) HIWORD_UPDATE(x, 3, 3)
44 #define RK3288_GRF_SOC_CON7 0x0260
45 #define RK3288_LVDS_PWRDWN(x) HIWORD_UPDATE(x, 15, 15)
46 #define RK3288_LVDS_CON_ENABLE_2(x) HIWORD_UPDATE(x, 12, 12)
47 #define RK3288_LVDS_CON_ENABLE_1(x) HIWORD_UPDATE(x, 11, 11)
48 #define RK3288_LVDS_CON_DEN_POL(x) HIWORD_UPDATE(x, 10, 10)
49 #define RK3288_LVDS_CON_HS_POL(x) HIWORD_UPDATE(x, 9, 9)
50 #define RK3288_LVDS_CON_CLKINV(x) HIWORD_UPDATE(x, 8, 8)
51 #define RK3288_LVDS_CON_STARTPHASE(x) HIWORD_UPDATE(x, 7, 7)
52 #define RK3288_LVDS_CON_TTL_EN(x) HIWORD_UPDATE(x, 6, 6)
53 #define RK3288_LVDS_CON_STARTSEL(x) HIWORD_UPDATE(x, 5, 5)
54 #define RK3288_LVDS_CON_CHASEL(x) HIWORD_UPDATE(x, 4, 4)
55 #define RK3288_LVDS_CON_MSBSEL(x) HIWORD_UPDATE(x, 3, 3)
56 #define RK3288_LVDS_CON_SELECT(x) HIWORD_UPDATE(x, 2, 0)
57
58 #define RK3368_GRF_SOC_CON7 0x041c
59 #define RK3368_LVDS_SELECT(x) HIWORD_UPDATE(x, 14, 13)
60 #define RK3368_LVDS_MODE_EN(x) HIWORD_UPDATE(x, 12, 12)
61 #define RK3368_LVDS_MSBSEL(x) HIWORD_UPDATE(x, 11, 11)
62 #define RK3368_LVDS_P2S_EN(x) HIWORD_UPDATE(x, 6, 6)
63
64 #define RK3562_GRF_VO_CON0 0x05d0
65 #define RK3562_GRF_VO_CON1 0x05d4
66
67 #define RK3568_GRF_VO_CON0 0x0360
68 #define RK3568_LVDS1_SELECT(x) HIWORD_UPDATE(x, 13, 12)
69 #define RK3568_LVDS1_MSBSEL(x) HIWORD_UPDATE(x, 11, 11)
70 #define RK3568_LVDS0_SELECT(x) HIWORD_UPDATE(x, 5, 4)
71 #define RK3568_LVDS0_MSBSEL(x) HIWORD_UPDATE(x, 3, 3)
72 #define RK3568_GRF_VO_CON2 0x0368
73 #define RK3568_LVDS0_DCLK_INV_SEL(x) HIWORD_UPDATE(x, 9, 9)
74 #define RK3568_LVDS0_DCLK_DIV2_SEL(x) HIWORD_UPDATE(x, 8, 8)
75 #define RK3568_LVDS0_MODE_EN(x) HIWORD_UPDATE(x, 1, 1)
76 #define RK3568_LVDS0_P2S_EN(x) HIWORD_UPDATE(x, 0, 0)
77 #define RK3568_GRF_VO_CON3 0x036c
78 #define RK3568_LVDS1_DCLK_INV_SEL(x) HIWORD_UPDATE(x, 9, 9)
79 #define RK3568_LVDS1_DCLK_DIV2_SEL(x) HIWORD_UPDATE(x, 8, 8)
80 #define RK3568_LVDS1_MODE_EN(x) HIWORD_UPDATE(x, 1, 1)
81 #define RK3568_LVDS1_P2S_EN(x) HIWORD_UPDATE(x, 0, 0)
82
83 enum lvds_format {
84 LVDS_8BIT_MODE_FORMAT_1,
85 LVDS_8BIT_MODE_FORMAT_2,
86 LVDS_6BIT_MODE_FORMAT_1,
87 LVDS_6BIT_MODE_FORMAT_2,
88 LVDS_10BIT_MODE_FORMAT_1,
89 LVDS_10BIT_MODE_FORMAT_2,
90 };
91
92 struct rockchip_lvds;
93
94 struct rockchip_lvds_funcs {
95 int (*probe)(struct rockchip_lvds *lvds);
96 void (*enable)(struct rockchip_lvds *lvds);
97 void (*disable)(struct rockchip_lvds *lvds);
98 };
99
100 struct rockchip_lvds {
101 int id;
102 struct device *dev;
103 struct phy *phy;
104 struct regmap *grf;
105 const struct rockchip_lvds_funcs *funcs;
106 enum lvds_format format;
107 bool data_swap;
108 bool dual_channel;
109 bool phy_enabled;
110 enum drm_lvds_dual_link_pixels pixel_order;
111
112 struct rockchip_lvds *primary;
113 struct rockchip_lvds *secondary;
114
115 struct drm_panel *panel;
116 struct drm_bridge *bridge;
117 struct drm_connector connector;
118 struct drm_encoder encoder;
119 struct drm_display_mode mode;
120 struct rockchip_drm_sub_dev sub_dev;
121 };
122
connector_to_lvds(struct drm_connector * c)123 static inline struct rockchip_lvds *connector_to_lvds(struct drm_connector *c)
124 {
125 return container_of(c, struct rockchip_lvds, connector);
126 }
127
encoder_to_lvds(struct drm_encoder * e)128 static inline struct rockchip_lvds *encoder_to_lvds(struct drm_encoder *e)
129 {
130 return container_of(e, struct rockchip_lvds, encoder);
131 }
132
133 static int
rockchip_lvds_atomic_connector_get_property(struct drm_connector * connector,const struct drm_connector_state * state,struct drm_property * property,uint64_t * val)134 rockchip_lvds_atomic_connector_get_property(struct drm_connector *connector,
135 const struct drm_connector_state *state,
136 struct drm_property *property,
137 uint64_t *val)
138 {
139 struct rockchip_lvds *lvds = connector_to_lvds(connector);
140 struct rockchip_drm_private *private = connector->dev->dev_private;
141
142 if (property == private->connector_id_prop) {
143 *val = lvds->id;
144 return 0;
145 }
146
147 DRM_ERROR("failed to get rockchip LVDS property\n");
148 return -EINVAL;
149 }
150
151 static const struct drm_connector_funcs rockchip_lvds_connector_funcs = {
152 .fill_modes = drm_helper_probe_single_connector_modes,
153 .destroy = drm_connector_cleanup,
154 .reset = drm_atomic_helper_connector_reset,
155 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
156 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
157 .atomic_get_property = rockchip_lvds_atomic_connector_get_property,
158 };
159
rockchip_lvds_connector_get_modes(struct drm_connector * connector)160 static int rockchip_lvds_connector_get_modes(struct drm_connector *connector)
161 {
162 struct rockchip_lvds *lvds = connector_to_lvds(connector);
163 struct drm_panel *panel = lvds->panel;
164
165 return drm_panel_get_modes(panel, connector);
166 }
167
168 static const
169 struct drm_connector_helper_funcs rockchip_lvds_connector_helper_funcs = {
170 .get_modes = rockchip_lvds_connector_get_modes,
171 };
172
173 static void
rockchip_lvds_encoder_atomic_mode_set(struct drm_encoder * encoder,struct drm_crtc_state * crtc_state,struct drm_connector_state * conn_state)174 rockchip_lvds_encoder_atomic_mode_set(struct drm_encoder *encoder,
175 struct drm_crtc_state *crtc_state,
176 struct drm_connector_state *conn_state)
177 {
178 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
179 struct drm_connector *connector = &lvds->connector;
180 struct drm_display_info *info = &connector->display_info;
181 u32 bus_format = MEDIA_BUS_FMT_RGB888_1X7X4_SPWG;
182
183 if (info->num_bus_formats)
184 bus_format = info->bus_formats[0];
185
186 switch (bus_format) {
187 case MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA: /* jeida-24 */
188 lvds->format = LVDS_8BIT_MODE_FORMAT_2;
189 break;
190 case MEDIA_BUS_FMT_RGB101010_1X7X5_JEIDA: /* jeida-30 */
191 lvds->format = LVDS_10BIT_MODE_FORMAT_2;
192 break;
193 case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG: /* jeida-18, compatible with the [JEIDA], [LDI] and [VESA] specifications */
194 lvds->format = LVDS_6BIT_MODE_FORMAT_1;
195 break;
196 case MEDIA_BUS_FMT_RGB101010_1X7X5_SPWG: /* vesa-30 */
197 lvds->format = LVDS_10BIT_MODE_FORMAT_1;
198 break;
199 case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG: /* vesa-24 */
200 default:
201 lvds->format = LVDS_8BIT_MODE_FORMAT_1;
202 break;
203 }
204
205 if (lvds->secondary)
206 lvds->secondary->format = lvds->format;
207
208 drm_mode_copy(&lvds->mode, &crtc_state->adjusted_mode);
209 }
210
211 static int
rockchip_lvds_encoder_atomic_check(struct drm_encoder * encoder,struct drm_crtc_state * crtc_state,struct drm_connector_state * conn_state)212 rockchip_lvds_encoder_atomic_check(struct drm_encoder *encoder,
213 struct drm_crtc_state *crtc_state,
214 struct drm_connector_state *conn_state)
215 {
216 struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
217 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
218 struct drm_connector *connector = conn_state->connector;
219 struct drm_display_info *info = &connector->display_info;
220
221 if (info->num_bus_formats)
222 s->bus_format = info->bus_formats[0];
223 else
224 s->bus_format = MEDIA_BUS_FMT_RGB888_1X7X4_SPWG;
225
226 s->output_mode = ROCKCHIP_OUT_MODE_P888;
227
228 if (s->bus_format == MEDIA_BUS_FMT_RGB101010_1X7X5_SPWG ||
229 s->bus_format == MEDIA_BUS_FMT_RGB101010_1X7X5_JEIDA)
230 s->output_mode = ROCKCHIP_OUT_MODE_AAAA;
231
232 s->output_type = DRM_MODE_CONNECTOR_LVDS;
233 s->bus_flags = info->bus_flags;
234 s->tv_state = &conn_state->tv;
235 s->eotf = HDMI_EOTF_TRADITIONAL_GAMMA_SDR;
236 s->color_space = V4L2_COLORSPACE_DEFAULT;
237
238 switch (lvds->pixel_order) {
239 case DRM_LVDS_DUAL_LINK_ODD_EVEN_PIXELS:
240 s->output_flags |= ROCKCHIP_OUTPUT_DUAL_CHANNEL_ODD_EVEN_MODE;
241 s->output_if |= VOP_OUTPUT_IF_LVDS1 | VOP_OUTPUT_IF_LVDS0;
242 break;
243 case DRM_LVDS_DUAL_LINK_EVEN_ODD_PIXELS:
244 s->output_flags |= ROCKCHIP_OUTPUT_DUAL_CHANNEL_ODD_EVEN_MODE;
245 s->output_flags |= ROCKCHIP_OUTPUT_DATA_SWAP;
246 s->output_if |= VOP_OUTPUT_IF_LVDS1 | VOP_OUTPUT_IF_LVDS0;
247 break;
248 /*
249 * Fix me: To do it with a GKI compatible version.
250 */
251 #if 0
252 case DRM_LVDS_DUAL_LINK_LEFT_RIGHT_PIXELS:
253 s->output_flags |= ROCKCHIP_OUTPUT_DUAL_CHANNEL_LEFT_RIGHT_MODE;
254 s->output_if |= VOP_OUTPUT_IF_LVDS1 | VOP_OUTPUT_IF_LVDS0;
255 break;
256 case DRM_LVDS_DUAL_LINK_RIGHT_LEFT_PIXELS:
257 s->output_flags |= ROCKCHIP_OUTPUT_DUAL_CHANNEL_LEFT_RIGHT_MODE;
258 s->output_flags |= ROCKCHIP_OUTPUT_DATA_SWAP;
259 s->output_if |= VOP_OUTPUT_IF_LVDS1 | VOP_OUTPUT_IF_LVDS0;
260 break;
261 #endif
262 default:
263 if (lvds->id)
264 s->output_if |= VOP_OUTPUT_IF_LVDS1;
265 else
266 s->output_if |= VOP_OUTPUT_IF_LVDS0;
267 break;
268 }
269
270 return 0;
271 }
272
rockchip_lvds_enable(struct rockchip_lvds * lvds)273 static void rockchip_lvds_enable(struct rockchip_lvds *lvds)
274 {
275 int ret;
276
277 if (lvds->funcs->enable)
278 lvds->funcs->enable(lvds);
279
280 ret = phy_set_mode(lvds->phy, PHY_MODE_LVDS);
281 if (ret) {
282 DRM_DEV_ERROR(lvds->dev, "failed to set phy mode: %d\n", ret);
283 return;
284 }
285
286 if (lvds->phy && !lvds->phy_enabled) {
287 phy_power_on(lvds->phy);
288 lvds->phy_enabled = true;
289 }
290
291 if (lvds->secondary)
292 rockchip_lvds_enable(lvds->secondary);
293 }
294
rockchip_lvds_disable(struct rockchip_lvds * lvds)295 static void rockchip_lvds_disable(struct rockchip_lvds *lvds)
296 {
297 if (lvds->funcs->disable)
298 lvds->funcs->disable(lvds);
299
300 if (lvds->phy && lvds->phy_enabled) {
301 phy_power_off(lvds->phy);
302 lvds->phy_enabled = false;
303 }
304
305 if (lvds->secondary)
306 rockchip_lvds_disable(lvds->secondary);
307 }
308
rockchip_lvds_encoder_enable(struct drm_encoder * encoder)309 static void rockchip_lvds_encoder_enable(struct drm_encoder *encoder)
310 {
311 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
312
313 if (lvds->panel)
314 drm_panel_prepare(lvds->panel);
315 rockchip_lvds_enable(lvds);
316 if (lvds->panel)
317 drm_panel_enable(lvds->panel);
318 }
319
rockchip_lvds_encoder_disable(struct drm_encoder * encoder)320 static void rockchip_lvds_encoder_disable(struct drm_encoder *encoder)
321 {
322 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
323
324 if (lvds->panel)
325 drm_panel_disable(lvds->panel);
326 rockchip_lvds_disable(lvds);
327 if (lvds->panel)
328 drm_panel_unprepare(lvds->panel);
329 }
330
rockchip_lvds_encoder_loader_protect(struct drm_encoder * encoder,bool on)331 static int rockchip_lvds_encoder_loader_protect(struct drm_encoder *encoder,
332 bool on)
333 {
334 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
335
336 if (lvds->panel)
337 panel_simple_loader_protect(lvds->panel);
338
339
340 if (on) {
341 phy_init(lvds->phy);
342 if (lvds->phy) {
343 lvds->phy->power_count++;
344 lvds->phy_enabled = true;
345 }
346 } else {
347 phy_exit(lvds->phy);
348 if (lvds->phy) {
349 lvds->phy->power_count--;
350 lvds->phy_enabled = false;
351 }
352 }
353
354 return 0;
355 }
356
357 static const
358 struct drm_encoder_helper_funcs rockchip_lvds_encoder_helper_funcs = {
359 .enable = rockchip_lvds_encoder_enable,
360 .disable = rockchip_lvds_encoder_disable,
361 .atomic_check = rockchip_lvds_encoder_atomic_check,
362 .atomic_mode_set = rockchip_lvds_encoder_atomic_mode_set,
363 };
364
365 static const struct drm_encoder_funcs rockchip_lvds_encoder_funcs = {
366 .destroy = drm_encoder_cleanup,
367 };
368
rockchip_lvds_match_by_id(struct device * dev,const void * data)369 static int rockchip_lvds_match_by_id(struct device *dev, const void *data)
370 {
371 struct rockchip_lvds *lvds = dev_get_drvdata(dev);
372 unsigned int *id = (unsigned int *)data;
373
374 return lvds->id == *id;
375 }
376
rockchip_lvds_find_by_id(struct device_driver * drv,unsigned int id)377 static struct rockchip_lvds *rockchip_lvds_find_by_id(struct device_driver *drv,
378 unsigned int id)
379 {
380 struct device *dev;
381
382 dev = driver_find_device(drv, NULL, &id, rockchip_lvds_match_by_id);
383 if (!dev)
384 return NULL;
385
386 return dev_get_drvdata(dev);
387 }
388
rockchip_lvds_bind(struct device * dev,struct device * master,void * data)389 static int rockchip_lvds_bind(struct device *dev, struct device *master,
390 void *data)
391 {
392 struct rockchip_lvds *lvds = dev_get_drvdata(dev);
393 struct drm_device *drm_dev = data;
394 struct drm_encoder *encoder = &lvds->encoder;
395 struct drm_connector *connector = &lvds->connector;
396 int ret;
397
398 /*
399 * dual channel lvds mode only need to register one connector.
400 */
401 if (lvds->primary)
402 return 0;
403
404 ret = drm_of_find_panel_or_bridge(dev->of_node, 1, -1,
405 &lvds->panel, &lvds->bridge);
406 if (ret)
407 return ret;
408
409 encoder->possible_crtcs = rockchip_drm_of_find_possible_crtcs(drm_dev,
410 dev->of_node);
411
412 ret = drm_encoder_init(drm_dev, encoder, &rockchip_lvds_encoder_funcs,
413 DRM_MODE_ENCODER_LVDS, NULL);
414 if (ret < 0) {
415 DRM_DEV_ERROR(lvds->dev,
416 "failed to initialize encoder: %d\n", ret);
417 return ret;
418 }
419
420 drm_encoder_helper_add(encoder, &rockchip_lvds_encoder_helper_funcs);
421
422 if (lvds->panel) {
423 struct rockchip_drm_private *private = drm_dev->dev_private;
424
425 ret = drm_connector_init(drm_dev, connector,
426 &rockchip_lvds_connector_funcs,
427 DRM_MODE_CONNECTOR_LVDS);
428 if (ret < 0) {
429 DRM_DEV_ERROR(drm_dev->dev,
430 "failed to initialize connector: %d\n", ret);
431 goto err_free_encoder;
432 }
433
434 drm_connector_helper_add(connector,
435 &rockchip_lvds_connector_helper_funcs);
436
437 ret = drm_connector_attach_encoder(connector, encoder);
438 if (ret < 0) {
439 DRM_DEV_ERROR(lvds->dev,
440 "failed to attach encoder: %d\n", ret);
441 goto err_free_connector;
442 }
443
444 lvds->sub_dev.connector = &lvds->connector;
445 lvds->sub_dev.of_node = lvds->dev->of_node;
446 lvds->sub_dev.loader_protect = rockchip_lvds_encoder_loader_protect;
447 rockchip_drm_register_sub_dev(&lvds->sub_dev);
448 drm_object_attach_property(&connector->base, private->connector_id_prop, 0);
449 } else {
450 ret = drm_bridge_attach(encoder, lvds->bridge, NULL, 0);
451 if (ret) {
452 DRM_DEV_ERROR(lvds->dev,
453 "failed to attach bridge: %d\n", ret);
454 goto err_free_encoder;
455 }
456 }
457
458 return 0;
459
460 err_free_connector:
461 drm_connector_cleanup(connector);
462 err_free_encoder:
463 drm_encoder_cleanup(encoder);
464 return ret;
465 }
466
rockchip_lvds_unbind(struct device * dev,struct device * master,void * data)467 static void rockchip_lvds_unbind(struct device *dev, struct device *master,
468 void *data)
469 {
470 struct rockchip_lvds *lvds = dev_get_drvdata(dev);
471
472 if (lvds->sub_dev.connector)
473 rockchip_drm_unregister_sub_dev(&lvds->sub_dev);
474 if (lvds->panel)
475 drm_connector_cleanup(&lvds->connector);
476
477 if (lvds->encoder.dev)
478 drm_encoder_cleanup(&lvds->encoder);
479 }
480
481 static const struct component_ops rockchip_lvds_component_ops = {
482 .bind = rockchip_lvds_bind,
483 .unbind = rockchip_lvds_unbind,
484 };
485
rockchip_lvds_probe(struct platform_device * pdev)486 static int rockchip_lvds_probe(struct platform_device *pdev)
487 {
488 struct device *dev = &pdev->dev;
489 struct rockchip_lvds *lvds;
490 int ret;
491
492 if (!dev->of_node)
493 return -ENODEV;
494
495 lvds = devm_kzalloc(dev, sizeof(*lvds), GFP_KERNEL);
496 if (!lvds)
497 return -ENOMEM;
498
499 lvds->id = of_alias_get_id(dev->of_node, "lvds");
500 if (lvds->id < 0)
501 lvds->id = 0;
502
503 lvds->dev = dev;
504 lvds->funcs = of_device_get_match_data(dev);
505 platform_set_drvdata(pdev, lvds);
506
507 lvds->dual_channel = of_property_read_bool(dev->of_node,
508 "dual-channel");
509 lvds->data_swap = of_property_read_bool(dev->of_node,
510 "rockchip,data-swap");
511
512 lvds->phy = devm_phy_get(dev, "phy");
513 if (IS_ERR(lvds->phy)) {
514 ret = PTR_ERR(lvds->phy);
515 DRM_DEV_ERROR(dev, "failed to get phy: %d\n", ret);
516 return ret;
517 }
518
519 lvds->grf = syscon_node_to_regmap(dev->parent->of_node);
520 if (IS_ERR(lvds->grf)) {
521 ret = PTR_ERR(lvds->grf);
522 DRM_DEV_ERROR(dev, "Unable to get grf: %d\n", ret);
523 return ret;
524 }
525
526 lvds->pixel_order = -1;
527 if (lvds->funcs->probe) {
528 ret = lvds->funcs->probe(lvds);
529 if (ret)
530 return ret;
531 }
532
533 return component_add(dev, &rockchip_lvds_component_ops);
534 }
535
rockchip_lvds_remove(struct platform_device * pdev)536 static int rockchip_lvds_remove(struct platform_device *pdev)
537 {
538 component_del(&pdev->dev, &rockchip_lvds_component_ops);
539
540 return 0;
541 }
542
px30_lvds_enable(struct rockchip_lvds * lvds)543 static void px30_lvds_enable(struct rockchip_lvds *lvds)
544 {
545 int pipe = drm_of_encoder_active_endpoint_id(lvds->dev->of_node,
546 &lvds->encoder);
547
548 regmap_write(lvds->grf, PX30_GRF_PD_VO_CON1,
549 PX30_LVDS_SELECT(lvds->format) |
550 PX30_LVDS_MODE_EN(1) | PX30_LVDS_MSBSEL(1) |
551 PX30_LVDS_P2S_EN(1) | PX30_LVDS_VOP_SEL(pipe));
552 }
553
px30_lvds_disable(struct rockchip_lvds * lvds)554 static void px30_lvds_disable(struct rockchip_lvds *lvds)
555 {
556 regmap_write(lvds->grf, PX30_GRF_PD_VO_CON1,
557 PX30_LVDS_MODE_EN(0) | PX30_LVDS_P2S_EN(0));
558 }
559
560 static const struct rockchip_lvds_funcs px30_lvds_funcs = {
561 .enable = px30_lvds_enable,
562 .disable = px30_lvds_disable,
563 };
564
rk3126_lvds_enable(struct rockchip_lvds * lvds)565 static void rk3126_lvds_enable(struct rockchip_lvds *lvds)
566 {
567 regmap_write(lvds->grf, RK3126_GRF_LVDS_CON0,
568 RK3126_LVDS_P2S_EN(1) | RK3126_LVDS_MODE_EN(1) |
569 RK3126_LVDS_MSBSEL(1) | RK3126_LVDS_SELECT(lvds->format));
570 }
571
rk3126_lvds_disable(struct rockchip_lvds * lvds)572 static void rk3126_lvds_disable(struct rockchip_lvds *lvds)
573 {
574 regmap_write(lvds->grf, RK3126_GRF_LVDS_CON0,
575 RK3126_LVDS_P2S_EN(0) | RK3126_LVDS_MODE_EN(0));
576 }
577
578 static const struct rockchip_lvds_funcs rk3126_lvds_funcs = {
579 .enable = rk3126_lvds_enable,
580 .disable = rk3126_lvds_disable,
581 };
582
rk3288_lvds_enable(struct rockchip_lvds * lvds)583 static void rk3288_lvds_enable(struct rockchip_lvds *lvds)
584 {
585 struct drm_display_mode *mode = &lvds->mode;
586 int pipe;
587 u32 val;
588
589 pipe = drm_of_encoder_active_endpoint_id(lvds->dev->of_node,
590 &lvds->encoder);
591 regmap_write(lvds->grf, RK3288_GRF_SOC_CON6,
592 RK3288_LVDS_LCDC_SEL(pipe));
593
594 val = RK3288_LVDS_PWRDWN(0) | RK3288_LVDS_CON_CLKINV(0) |
595 RK3288_LVDS_CON_CHASEL(lvds->dual_channel) |
596 RK3288_LVDS_CON_SELECT(lvds->format);
597
598 if (lvds->dual_channel) {
599 u32 h_bp = mode->htotal - mode->hsync_start;
600
601 val |= RK3288_LVDS_CON_ENABLE_2(1) |
602 RK3288_LVDS_CON_ENABLE_1(1) |
603 RK3288_LVDS_CON_STARTSEL(lvds->data_swap);
604
605 if (h_bp % 2)
606 val |= RK3288_LVDS_CON_STARTPHASE(1);
607 else
608 val |= RK3288_LVDS_CON_STARTPHASE(0);
609
610 } else {
611 val |= RK3288_LVDS_CON_ENABLE_2(0) |
612 RK3288_LVDS_CON_ENABLE_1(1);
613 }
614
615 regmap_write(lvds->grf, RK3288_GRF_SOC_CON7, val);
616
617 phy_set_bus_width(lvds->phy, lvds->dual_channel ? 2 : 1);
618 }
619
rk3288_lvds_disable(struct rockchip_lvds * lvds)620 static void rk3288_lvds_disable(struct rockchip_lvds *lvds)
621 {
622 regmap_write(lvds->grf, RK3288_GRF_SOC_CON7, RK3288_LVDS_PWRDWN(1));
623 }
624
625 static const struct rockchip_lvds_funcs rk3288_lvds_funcs = {
626 .enable = rk3288_lvds_enable,
627 .disable = rk3288_lvds_disable,
628 };
629
rk3368_lvds_enable(struct rockchip_lvds * lvds)630 static void rk3368_lvds_enable(struct rockchip_lvds *lvds)
631 {
632 regmap_write(lvds->grf, RK3368_GRF_SOC_CON7,
633 RK3368_LVDS_SELECT(lvds->format) |
634 RK3368_LVDS_MODE_EN(1) | RK3368_LVDS_MSBSEL(1) |
635 RK3368_LVDS_P2S_EN(1));
636 }
637
rk3368_lvds_disable(struct rockchip_lvds * lvds)638 static void rk3368_lvds_disable(struct rockchip_lvds *lvds)
639 {
640 regmap_write(lvds->grf, RK3368_GRF_SOC_CON7,
641 RK3368_LVDS_MODE_EN(0) | RK3368_LVDS_P2S_EN(0));
642 }
643
644 static const struct rockchip_lvds_funcs rk3368_lvds_funcs = {
645 .enable = rk3368_lvds_enable,
646 .disable = rk3368_lvds_disable,
647 };
648
rockchip_secondary_lvds_probe(struct rockchip_lvds * lvds)649 static int __maybe_unused rockchip_secondary_lvds_probe(struct rockchip_lvds *lvds)
650 {
651 if (lvds->dual_channel) {
652 struct rockchip_lvds *secondary = NULL;
653 struct device_node *port0, *port1;
654 int pixel_order;
655
656 secondary = rockchip_lvds_find_by_id(lvds->dev->driver, 1);
657 if (!secondary)
658 return -EPROBE_DEFER;
659
660 port0 = of_graph_get_port_by_id(lvds->dev->of_node, 1);
661 port1 = of_graph_get_port_by_id(secondary->dev->of_node, 1);
662 pixel_order = drm_of_lvds_get_dual_link_pixel_order(port0, port1);
663 of_node_put(port1);
664 of_node_put(port0);
665
666 secondary->primary = lvds;
667 lvds->secondary = secondary;
668 lvds->pixel_order = pixel_order >= 0 ? pixel_order : 0;
669 }
670
671 return 0;
672 }
673
rk3562_lvds_enable(struct rockchip_lvds * lvds)674 static void rk3562_lvds_enable(struct rockchip_lvds *lvds)
675 {
676 regmap_write(lvds->grf, RK3562_GRF_VO_CON1,
677 RK3568_LVDS0_MODE_EN(1) | RK3568_LVDS0_P2S_EN(1) |
678 RK3568_LVDS0_DCLK_INV_SEL(1));
679 regmap_write(lvds->grf, RK3562_GRF_VO_CON0,
680 RK3568_LVDS0_SELECT(lvds->format) | RK3568_LVDS0_MSBSEL(1));
681 }
682
rk3562_lvds_disable(struct rockchip_lvds * lvds)683 static void rk3562_lvds_disable(struct rockchip_lvds *lvds)
684 {
685 regmap_write(lvds->grf, RK3562_GRF_VO_CON1, RK3568_LVDS0_MODE_EN(0));
686 }
687
688 static const struct rockchip_lvds_funcs rk3562_lvds_funcs = {
689 .enable = rk3562_lvds_enable,
690 .disable = rk3562_lvds_disable,
691 };
692
rk3568_lvds_enable(struct rockchip_lvds * lvds)693 static void rk3568_lvds_enable(struct rockchip_lvds *lvds)
694 {
695 regmap_write(lvds->grf, RK3568_GRF_VO_CON2,
696 RK3568_LVDS0_MODE_EN(1) | RK3568_LVDS0_P2S_EN(1) |
697 RK3568_LVDS0_DCLK_INV_SEL(1));
698 regmap_write(lvds->grf, RK3568_GRF_VO_CON0,
699 RK3568_LVDS0_SELECT(lvds->format) | RK3568_LVDS0_MSBSEL(1));
700 }
701
rk3568_lvds_disable(struct rockchip_lvds * lvds)702 static void rk3568_lvds_disable(struct rockchip_lvds *lvds)
703 {
704 regmap_write(lvds->grf, RK3568_GRF_VO_CON2, RK3568_LVDS0_MODE_EN(0));
705 }
706
707 static const struct rockchip_lvds_funcs rk3568_lvds_funcs = {
708 .enable = rk3568_lvds_enable,
709 .disable = rk3568_lvds_disable,
710 };
711
712 static const struct of_device_id rockchip_lvds_dt_ids[] = {
713 { .compatible = "rockchip,px30-lvds", .data = &px30_lvds_funcs },
714 { .compatible = "rockchip,rk3126-lvds", .data = &rk3126_lvds_funcs },
715 { .compatible = "rockchip,rk3288-lvds", .data = &rk3288_lvds_funcs },
716 { .compatible = "rockchip,rk3368-lvds", .data = &rk3368_lvds_funcs },
717 { .compatible = "rockchip,rk3562-lvds", .data = &rk3562_lvds_funcs },
718 { .compatible = "rockchip,rk3568-lvds", .data = &rk3568_lvds_funcs },
719 {}
720 };
721 MODULE_DEVICE_TABLE(of, rockchip_lvds_dt_ids);
722
723 struct platform_driver rockchip_lvds_driver = {
724 .probe = rockchip_lvds_probe,
725 .remove = rockchip_lvds_remove,
726 .driver = {
727 .name = "rockchip-lvds",
728 .of_match_table = of_match_ptr(rockchip_lvds_dt_ids),
729 },
730 };
731