1
2
3
4
5
6
7
8
9#include <linux/clk.h>
10#include <linux/component.h>
11#include <linux/mfd/syscon.h>
12#include <linux/of_graph.h>
13#include <linux/phy/phy.h>
14#include <linux/pinctrl/devinfo.h>
15#include <linux/platform_device.h>
16#include <linux/pm_runtime.h>
17#include <linux/regmap.h>
18#include <linux/reset.h>
19
20#include <drm/drm_atomic_helper.h>
21#include <drm/drm_bridge.h>
22#include <drm/drm_bridge_connector.h>
23#include <drm/drm_dp_helper.h>
24#include <drm/drm_of.h>
25#include <drm/drm_panel.h>
26#include <drm/drm_probe_helper.h>
27#include <drm/drm_simple_kms_helper.h>
28
29#include "rockchip_drm_drv.h"
30#include "rockchip_drm_vop.h"
31#include "rockchip_lvds.h"
32
33#define DISPLAY_OUTPUT_RGB 0
34#define DISPLAY_OUTPUT_LVDS 1
35#define DISPLAY_OUTPUT_DUAL_LVDS 2
36
37struct rockchip_lvds;
38
39#define connector_to_lvds(c) \
40 container_of(c, struct rockchip_lvds, connector)
41
42#define encoder_to_lvds(c) \
43 container_of(c, struct rockchip_lvds, encoder)
44
45
46
47
48
49
50struct rockchip_lvds_soc_data {
51 int (*probe)(struct platform_device *pdev, struct rockchip_lvds *lvds);
52 const struct drm_encoder_helper_funcs *helper_funcs;
53};
54
55struct rockchip_lvds {
56 struct device *dev;
57 void __iomem *regs;
58 struct regmap *grf;
59 struct clk *pclk;
60 struct phy *dphy;
61 const struct rockchip_lvds_soc_data *soc_data;
62 int output;
63 int format;
64 struct drm_device *drm_dev;
65 struct drm_panel *panel;
66 struct drm_bridge *bridge;
67 struct drm_connector connector;
68 struct drm_encoder encoder;
69 struct dev_pin_info *pins;
70};
71
72static inline void rk3288_writel(struct rockchip_lvds *lvds, u32 offset,
73 u32 val)
74{
75 writel_relaxed(val, lvds->regs + offset);
76 if (lvds->output == DISPLAY_OUTPUT_LVDS)
77 return;
78 writel_relaxed(val, lvds->regs + offset + RK3288_LVDS_CH1_OFFSET);
79}
80
81static inline int rockchip_lvds_name_to_format(const char *s)
82{
83 if (strncmp(s, "jeida-18", 8) == 0)
84 return LVDS_JEIDA_18;
85 else if (strncmp(s, "jeida-24", 8) == 0)
86 return LVDS_JEIDA_24;
87 else if (strncmp(s, "vesa-24", 7) == 0)
88 return LVDS_VESA_24;
89
90 return -EINVAL;
91}
92
93static inline int rockchip_lvds_name_to_output(const char *s)
94{
95 if (strncmp(s, "rgb", 3) == 0)
96 return DISPLAY_OUTPUT_RGB;
97 else if (strncmp(s, "lvds", 4) == 0)
98 return DISPLAY_OUTPUT_LVDS;
99 else if (strncmp(s, "duallvds", 8) == 0)
100 return DISPLAY_OUTPUT_DUAL_LVDS;
101
102 return -EINVAL;
103}
104
105static const struct drm_connector_funcs rockchip_lvds_connector_funcs = {
106 .fill_modes = drm_helper_probe_single_connector_modes,
107 .destroy = drm_connector_cleanup,
108 .reset = drm_atomic_helper_connector_reset,
109 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
110 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
111};
112
113static int rockchip_lvds_connector_get_modes(struct drm_connector *connector)
114{
115 struct rockchip_lvds *lvds = connector_to_lvds(connector);
116 struct drm_panel *panel = lvds->panel;
117
118 return drm_panel_get_modes(panel, connector);
119}
120
121static const
122struct drm_connector_helper_funcs rockchip_lvds_connector_helper_funcs = {
123 .get_modes = rockchip_lvds_connector_get_modes,
124};
125
126static int
127rockchip_lvds_encoder_atomic_check(struct drm_encoder *encoder,
128 struct drm_crtc_state *crtc_state,
129 struct drm_connector_state *conn_state)
130{
131 struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
132
133 s->output_mode = ROCKCHIP_OUT_MODE_P888;
134 s->output_type = DRM_MODE_CONNECTOR_LVDS;
135
136 return 0;
137}
138
139static int rk3288_lvds_poweron(struct rockchip_lvds *lvds)
140{
141 int ret;
142 u32 val;
143
144 ret = clk_enable(lvds->pclk);
145 if (ret < 0) {
146 DRM_DEV_ERROR(lvds->dev, "failed to enable lvds pclk %d\n", ret);
147 return ret;
148 }
149 ret = pm_runtime_get_sync(lvds->dev);
150 if (ret < 0) {
151 DRM_DEV_ERROR(lvds->dev, "failed to get pm runtime: %d\n", ret);
152 clk_disable(lvds->pclk);
153 return ret;
154 }
155 val = RK3288_LVDS_CH0_REG0_LANE4_EN | RK3288_LVDS_CH0_REG0_LANE3_EN |
156 RK3288_LVDS_CH0_REG0_LANE2_EN | RK3288_LVDS_CH0_REG0_LANE1_EN |
157 RK3288_LVDS_CH0_REG0_LANE0_EN;
158 if (lvds->output == DISPLAY_OUTPUT_RGB) {
159 val |= RK3288_LVDS_CH0_REG0_TTL_EN |
160 RK3288_LVDS_CH0_REG0_LANECK_EN;
161 rk3288_writel(lvds, RK3288_LVDS_CH0_REG0, val);
162 rk3288_writel(lvds, RK3288_LVDS_CH0_REG2,
163 RK3288_LVDS_PLL_FBDIV_REG2(0x46));
164 rk3288_writel(lvds, RK3288_LVDS_CH0_REG4,
165 RK3288_LVDS_CH0_REG4_LANECK_TTL_MODE |
166 RK3288_LVDS_CH0_REG4_LANE4_TTL_MODE |
167 RK3288_LVDS_CH0_REG4_LANE3_TTL_MODE |
168 RK3288_LVDS_CH0_REG4_LANE2_TTL_MODE |
169 RK3288_LVDS_CH0_REG4_LANE1_TTL_MODE |
170 RK3288_LVDS_CH0_REG4_LANE0_TTL_MODE);
171 rk3288_writel(lvds, RK3288_LVDS_CH0_REG5,
172 RK3288_LVDS_CH0_REG5_LANECK_TTL_DATA |
173 RK3288_LVDS_CH0_REG5_LANE4_TTL_DATA |
174 RK3288_LVDS_CH0_REG5_LANE3_TTL_DATA |
175 RK3288_LVDS_CH0_REG5_LANE2_TTL_DATA |
176 RK3288_LVDS_CH0_REG5_LANE1_TTL_DATA |
177 RK3288_LVDS_CH0_REG5_LANE0_TTL_DATA);
178 } else {
179 val |= RK3288_LVDS_CH0_REG0_LVDS_EN |
180 RK3288_LVDS_CH0_REG0_LANECK_EN;
181 rk3288_writel(lvds, RK3288_LVDS_CH0_REG0, val);
182 rk3288_writel(lvds, RK3288_LVDS_CH0_REG1,
183 RK3288_LVDS_CH0_REG1_LANECK_BIAS |
184 RK3288_LVDS_CH0_REG1_LANE4_BIAS |
185 RK3288_LVDS_CH0_REG1_LANE3_BIAS |
186 RK3288_LVDS_CH0_REG1_LANE2_BIAS |
187 RK3288_LVDS_CH0_REG1_LANE1_BIAS |
188 RK3288_LVDS_CH0_REG1_LANE0_BIAS);
189 rk3288_writel(lvds, RK3288_LVDS_CH0_REG2,
190 RK3288_LVDS_CH0_REG2_RESERVE_ON |
191 RK3288_LVDS_CH0_REG2_LANECK_LVDS_MODE |
192 RK3288_LVDS_CH0_REG2_LANE4_LVDS_MODE |
193 RK3288_LVDS_CH0_REG2_LANE3_LVDS_MODE |
194 RK3288_LVDS_CH0_REG2_LANE2_LVDS_MODE |
195 RK3288_LVDS_CH0_REG2_LANE1_LVDS_MODE |
196 RK3288_LVDS_CH0_REG2_LANE0_LVDS_MODE |
197 RK3288_LVDS_PLL_FBDIV_REG2(0x46));
198 rk3288_writel(lvds, RK3288_LVDS_CH0_REG4, 0x00);
199 rk3288_writel(lvds, RK3288_LVDS_CH0_REG5, 0x00);
200 }
201 rk3288_writel(lvds, RK3288_LVDS_CH0_REG3,
202 RK3288_LVDS_PLL_FBDIV_REG3(0x46));
203 rk3288_writel(lvds, RK3288_LVDS_CH0_REGD,
204 RK3288_LVDS_PLL_PREDIV_REGD(0x0a));
205 rk3288_writel(lvds, RK3288_LVDS_CH0_REG20,
206 RK3288_LVDS_CH0_REG20_LSB);
207
208 rk3288_writel(lvds, RK3288_LVDS_CFG_REGC,
209 RK3288_LVDS_CFG_REGC_PLL_ENABLE);
210 rk3288_writel(lvds, RK3288_LVDS_CFG_REG21,
211 RK3288_LVDS_CFG_REG21_TX_ENABLE);
212
213 return 0;
214}
215
216static void rk3288_lvds_poweroff(struct rockchip_lvds *lvds)
217{
218 int ret;
219 u32 val;
220
221 rk3288_writel(lvds, RK3288_LVDS_CFG_REG21,
222 RK3288_LVDS_CFG_REG21_TX_ENABLE);
223 rk3288_writel(lvds, RK3288_LVDS_CFG_REGC,
224 RK3288_LVDS_CFG_REGC_PLL_ENABLE);
225 val = LVDS_DUAL | LVDS_TTL_EN | LVDS_CH0_EN | LVDS_CH1_EN | LVDS_PWRDN;
226 val |= val << 16;
227 ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON7, val);
228 if (ret != 0)
229 DRM_DEV_ERROR(lvds->dev, "Could not write to GRF: %d\n", ret);
230
231 pm_runtime_put(lvds->dev);
232 clk_disable(lvds->pclk);
233}
234
235static int rk3288_lvds_grf_config(struct drm_encoder *encoder,
236 struct drm_display_mode *mode)
237{
238 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
239 u8 pin_hsync = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 1 : 0;
240 u8 pin_dclk = (mode->flags & DRM_MODE_FLAG_PCSYNC) ? 1 : 0;
241 u32 val;
242 int ret;
243
244
245 if (lvds->output == DISPLAY_OUTPUT_RGB)
246 if (lvds->pins && !IS_ERR(lvds->pins->default_state))
247 pinctrl_select_state(lvds->pins->p,
248 lvds->pins->default_state);
249 val = lvds->format | LVDS_CH0_EN;
250 if (lvds->output == DISPLAY_OUTPUT_RGB)
251 val |= LVDS_TTL_EN | LVDS_CH1_EN;
252 else if (lvds->output == DISPLAY_OUTPUT_DUAL_LVDS)
253 val |= LVDS_DUAL | LVDS_CH1_EN;
254
255 if ((mode->htotal - mode->hsync_start) & 0x01)
256 val |= LVDS_START_PHASE_RST_1;
257
258 val |= (pin_dclk << 8) | (pin_hsync << 9);
259 val |= (0xffff << 16);
260 ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON7, val);
261 if (ret)
262 DRM_DEV_ERROR(lvds->dev, "Could not write to GRF: %d\n", ret);
263
264 return ret;
265}
266
267static int rk3288_lvds_set_vop_source(struct rockchip_lvds *lvds,
268 struct drm_encoder *encoder)
269{
270 u32 val;
271 int ret;
272
273 ret = drm_of_encoder_active_endpoint_id(lvds->dev->of_node, encoder);
274 if (ret < 0)
275 return ret;
276
277 val = RK3288_LVDS_SOC_CON6_SEL_VOP_LIT << 16;
278 if (ret)
279 val |= RK3288_LVDS_SOC_CON6_SEL_VOP_LIT;
280
281 ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON6, val);
282 if (ret < 0)
283 return ret;
284
285 return 0;
286}
287
288static void rk3288_lvds_encoder_enable(struct drm_encoder *encoder)
289{
290 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
291 struct drm_display_mode *mode = &encoder->crtc->state->adjusted_mode;
292 int ret;
293
294 drm_panel_prepare(lvds->panel);
295
296 ret = rk3288_lvds_poweron(lvds);
297 if (ret < 0) {
298 DRM_DEV_ERROR(lvds->dev, "failed to power on LVDS: %d\n", ret);
299 drm_panel_unprepare(lvds->panel);
300 return;
301 }
302
303 ret = rk3288_lvds_grf_config(encoder, mode);
304 if (ret) {
305 DRM_DEV_ERROR(lvds->dev, "failed to configure LVDS: %d\n", ret);
306 drm_panel_unprepare(lvds->panel);
307 return;
308 }
309
310 ret = rk3288_lvds_set_vop_source(lvds, encoder);
311 if (ret) {
312 DRM_DEV_ERROR(lvds->dev, "failed to set VOP source: %d\n", ret);
313 drm_panel_unprepare(lvds->panel);
314 return;
315 }
316
317 drm_panel_enable(lvds->panel);
318}
319
320static void rk3288_lvds_encoder_disable(struct drm_encoder *encoder)
321{
322 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
323
324 drm_panel_disable(lvds->panel);
325 rk3288_lvds_poweroff(lvds);
326 drm_panel_unprepare(lvds->panel);
327}
328
329static int px30_lvds_poweron(struct rockchip_lvds *lvds)
330{
331 int ret;
332
333 ret = pm_runtime_get_sync(lvds->dev);
334 if (ret < 0) {
335 DRM_DEV_ERROR(lvds->dev, "failed to get pm runtime: %d\n", ret);
336 return ret;
337 }
338
339
340 return regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
341 PX30_LVDS_MODE_EN(1) | PX30_LVDS_P2S_EN(1),
342 PX30_LVDS_MODE_EN(1) | PX30_LVDS_P2S_EN(1));
343}
344
345static void px30_lvds_poweroff(struct rockchip_lvds *lvds)
346{
347 regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
348 PX30_LVDS_MODE_EN(1) | PX30_LVDS_P2S_EN(1),
349 PX30_LVDS_MODE_EN(0) | PX30_LVDS_P2S_EN(0));
350
351 pm_runtime_put(lvds->dev);
352}
353
354static int px30_lvds_grf_config(struct drm_encoder *encoder,
355 struct drm_display_mode *mode)
356{
357 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
358
359 if (lvds->output != DISPLAY_OUTPUT_LVDS) {
360 DRM_DEV_ERROR(lvds->dev, "Unsupported display output %d\n",
361 lvds->output);
362 return -EINVAL;
363 }
364
365
366 return regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
367 PX30_LVDS_FORMAT(lvds->format),
368 PX30_LVDS_FORMAT(lvds->format));
369}
370
371static int px30_lvds_set_vop_source(struct rockchip_lvds *lvds,
372 struct drm_encoder *encoder)
373{
374 int vop;
375
376 vop = drm_of_encoder_active_endpoint_id(lvds->dev->of_node, encoder);
377 if (vop < 0)
378 return vop;
379
380 return regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
381 PX30_LVDS_VOP_SEL(1),
382 PX30_LVDS_VOP_SEL(vop));
383}
384
385static void px30_lvds_encoder_enable(struct drm_encoder *encoder)
386{
387 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
388 struct drm_display_mode *mode = &encoder->crtc->state->adjusted_mode;
389 int ret;
390
391 drm_panel_prepare(lvds->panel);
392
393 ret = px30_lvds_poweron(lvds);
394 if (ret) {
395 DRM_DEV_ERROR(lvds->dev, "failed to power on LVDS: %d\n", ret);
396 drm_panel_unprepare(lvds->panel);
397 return;
398 }
399
400 ret = px30_lvds_grf_config(encoder, mode);
401 if (ret) {
402 DRM_DEV_ERROR(lvds->dev, "failed to configure LVDS: %d\n", ret);
403 drm_panel_unprepare(lvds->panel);
404 return;
405 }
406
407 ret = px30_lvds_set_vop_source(lvds, encoder);
408 if (ret) {
409 DRM_DEV_ERROR(lvds->dev, "failed to set VOP source: %d\n", ret);
410 drm_panel_unprepare(lvds->panel);
411 return;
412 }
413
414 drm_panel_enable(lvds->panel);
415}
416
417static void px30_lvds_encoder_disable(struct drm_encoder *encoder)
418{
419 struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
420
421 drm_panel_disable(lvds->panel);
422 px30_lvds_poweroff(lvds);
423 drm_panel_unprepare(lvds->panel);
424}
425
426static const
427struct drm_encoder_helper_funcs rk3288_lvds_encoder_helper_funcs = {
428 .enable = rk3288_lvds_encoder_enable,
429 .disable = rk3288_lvds_encoder_disable,
430 .atomic_check = rockchip_lvds_encoder_atomic_check,
431};
432
433static const
434struct drm_encoder_helper_funcs px30_lvds_encoder_helper_funcs = {
435 .enable = px30_lvds_encoder_enable,
436 .disable = px30_lvds_encoder_disable,
437 .atomic_check = rockchip_lvds_encoder_atomic_check,
438};
439
440static int rk3288_lvds_probe(struct platform_device *pdev,
441 struct rockchip_lvds *lvds)
442{
443 int ret;
444
445 lvds->regs = devm_platform_ioremap_resource(pdev, 0);
446 if (IS_ERR(lvds->regs))
447 return PTR_ERR(lvds->regs);
448
449 lvds->pclk = devm_clk_get(lvds->dev, "pclk_lvds");
450 if (IS_ERR(lvds->pclk)) {
451 DRM_DEV_ERROR(lvds->dev, "could not get pclk_lvds\n");
452 return PTR_ERR(lvds->pclk);
453 }
454
455 lvds->pins = devm_kzalloc(lvds->dev, sizeof(*lvds->pins),
456 GFP_KERNEL);
457 if (!lvds->pins)
458 return -ENOMEM;
459
460 lvds->pins->p = devm_pinctrl_get(lvds->dev);
461 if (IS_ERR(lvds->pins->p)) {
462 DRM_DEV_ERROR(lvds->dev, "no pinctrl handle\n");
463 devm_kfree(lvds->dev, lvds->pins);
464 lvds->pins = NULL;
465 } else {
466 lvds->pins->default_state =
467 pinctrl_lookup_state(lvds->pins->p, "lcdc");
468 if (IS_ERR(lvds->pins->default_state)) {
469 DRM_DEV_ERROR(lvds->dev, "no default pinctrl state\n");
470 devm_kfree(lvds->dev, lvds->pins);
471 lvds->pins = NULL;
472 }
473 }
474
475 ret = clk_prepare(lvds->pclk);
476 if (ret < 0) {
477 DRM_DEV_ERROR(lvds->dev, "failed to prepare pclk_lvds\n");
478 return ret;
479 }
480
481 return 0;
482}
483
484static int px30_lvds_probe(struct platform_device *pdev,
485 struct rockchip_lvds *lvds)
486{
487 int ret;
488
489
490 ret = regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
491 PX30_LVDS_MSBSEL(1),
492 PX30_LVDS_MSBSEL(1));
493 if (ret)
494 return ret;
495
496
497 lvds->dphy = devm_phy_get(&pdev->dev, "dphy");
498 if (IS_ERR(lvds->dphy))
499 return PTR_ERR(lvds->dphy);
500
501 ret = phy_init(lvds->dphy);
502 if (ret)
503 return ret;
504
505 ret = phy_set_mode(lvds->dphy, PHY_MODE_LVDS);
506 if (ret)
507 return ret;
508
509 return phy_power_on(lvds->dphy);
510}
511
512static const struct rockchip_lvds_soc_data rk3288_lvds_data = {
513 .probe = rk3288_lvds_probe,
514 .helper_funcs = &rk3288_lvds_encoder_helper_funcs,
515};
516
517static const struct rockchip_lvds_soc_data px30_lvds_data = {
518 .probe = px30_lvds_probe,
519 .helper_funcs = &px30_lvds_encoder_helper_funcs,
520};
521
522static const struct of_device_id rockchip_lvds_dt_ids[] = {
523 {
524 .compatible = "rockchip,rk3288-lvds",
525 .data = &rk3288_lvds_data
526 },
527 {
528 .compatible = "rockchip,px30-lvds",
529 .data = &px30_lvds_data
530 },
531 {}
532};
533MODULE_DEVICE_TABLE(of, rockchip_lvds_dt_ids);
534
535static int rockchip_lvds_bind(struct device *dev, struct device *master,
536 void *data)
537{
538 struct rockchip_lvds *lvds = dev_get_drvdata(dev);
539 struct drm_device *drm_dev = data;
540 struct drm_encoder *encoder;
541 struct drm_connector *connector;
542 struct device_node *remote = NULL;
543 struct device_node *port, *endpoint;
544 int ret = 0, child_count = 0;
545 const char *name;
546 u32 endpoint_id = 0;
547
548 lvds->drm_dev = drm_dev;
549 port = of_graph_get_port_by_id(dev->of_node, 1);
550 if (!port) {
551 DRM_DEV_ERROR(dev,
552 "can't found port point, please init lvds panel port!\n");
553 return -EINVAL;
554 }
555 for_each_child_of_node(port, endpoint) {
556 child_count++;
557 of_property_read_u32(endpoint, "reg", &endpoint_id);
558 ret = drm_of_find_panel_or_bridge(dev->of_node, 1, endpoint_id,
559 &lvds->panel, &lvds->bridge);
560 if (!ret) {
561 of_node_put(endpoint);
562 break;
563 }
564 }
565 if (!child_count) {
566 DRM_DEV_ERROR(dev, "lvds port does not have any children\n");
567 ret = -EINVAL;
568 goto err_put_port;
569 } else if (ret) {
570 DRM_DEV_ERROR(dev, "failed to find panel and bridge node\n");
571 ret = -EPROBE_DEFER;
572 goto err_put_port;
573 }
574 if (lvds->panel)
575 remote = lvds->panel->dev->of_node;
576 else
577 remote = lvds->bridge->of_node;
578 if (of_property_read_string(dev->of_node, "rockchip,output", &name))
579
580 lvds->output = DISPLAY_OUTPUT_RGB;
581 else
582 lvds->output = rockchip_lvds_name_to_output(name);
583
584 if (lvds->output < 0) {
585 DRM_DEV_ERROR(dev, "invalid output type [%s]\n", name);
586 ret = lvds->output;
587 goto err_put_remote;
588 }
589
590 if (of_property_read_string(remote, "data-mapping", &name))
591
592 lvds->format = LVDS_VESA_18;
593 else
594 lvds->format = rockchip_lvds_name_to_format(name);
595
596 if (lvds->format < 0) {
597 DRM_DEV_ERROR(dev, "invalid data-mapping format [%s]\n", name);
598 ret = lvds->format;
599 goto err_put_remote;
600 }
601
602 encoder = &lvds->encoder;
603 encoder->possible_crtcs = drm_of_find_possible_crtcs(drm_dev,
604 dev->of_node);
605
606 ret = drm_simple_encoder_init(drm_dev, encoder, DRM_MODE_ENCODER_LVDS);
607 if (ret < 0) {
608 DRM_DEV_ERROR(drm_dev->dev,
609 "failed to initialize encoder: %d\n", ret);
610 goto err_put_remote;
611 }
612
613 drm_encoder_helper_add(encoder, lvds->soc_data->helper_funcs);
614 connector = &lvds->connector;
615
616 if (lvds->panel) {
617 connector->dpms = DRM_MODE_DPMS_OFF;
618 ret = drm_connector_init(drm_dev, connector,
619 &rockchip_lvds_connector_funcs,
620 DRM_MODE_CONNECTOR_LVDS);
621 if (ret < 0) {
622 DRM_DEV_ERROR(drm_dev->dev,
623 "failed to initialize connector: %d\n", ret);
624 goto err_free_encoder;
625 }
626
627 drm_connector_helper_add(connector,
628 &rockchip_lvds_connector_helper_funcs);
629 } else {
630 ret = drm_bridge_attach(encoder, lvds->bridge, NULL,
631 DRM_BRIDGE_ATTACH_NO_CONNECTOR);
632 if (ret)
633 goto err_free_encoder;
634
635 connector = drm_bridge_connector_init(lvds->drm_dev, encoder);
636 if (IS_ERR(connector)) {
637 DRM_DEV_ERROR(drm_dev->dev,
638 "failed to initialize bridge connector: %pe\n",
639 connector);
640 ret = PTR_ERR(connector);
641 goto err_free_encoder;
642 }
643 }
644
645 ret = drm_connector_attach_encoder(connector, encoder);
646 if (ret < 0) {
647 DRM_DEV_ERROR(drm_dev->dev,
648 "failed to attach encoder: %d\n", ret);
649 goto err_free_connector;
650 }
651
652 pm_runtime_enable(dev);
653 of_node_put(remote);
654 of_node_put(port);
655
656 return 0;
657
658err_free_connector:
659 drm_connector_cleanup(connector);
660err_free_encoder:
661 drm_encoder_cleanup(encoder);
662err_put_remote:
663 of_node_put(remote);
664err_put_port:
665 of_node_put(port);
666
667 return ret;
668}
669
670static void rockchip_lvds_unbind(struct device *dev, struct device *master,
671 void *data)
672{
673 struct rockchip_lvds *lvds = dev_get_drvdata(dev);
674 const struct drm_encoder_helper_funcs *encoder_funcs;
675
676 encoder_funcs = lvds->soc_data->helper_funcs;
677 encoder_funcs->disable(&lvds->encoder);
678 pm_runtime_disable(dev);
679 drm_connector_cleanup(&lvds->connector);
680 drm_encoder_cleanup(&lvds->encoder);
681}
682
683static const struct component_ops rockchip_lvds_component_ops = {
684 .bind = rockchip_lvds_bind,
685 .unbind = rockchip_lvds_unbind,
686};
687
688static int rockchip_lvds_probe(struct platform_device *pdev)
689{
690 struct device *dev = &pdev->dev;
691 struct rockchip_lvds *lvds;
692 const struct of_device_id *match;
693 int ret;
694
695 if (!dev->of_node)
696 return -ENODEV;
697
698 lvds = devm_kzalloc(&pdev->dev, sizeof(*lvds), GFP_KERNEL);
699 if (!lvds)
700 return -ENOMEM;
701
702 lvds->dev = dev;
703 match = of_match_node(rockchip_lvds_dt_ids, dev->of_node);
704 if (!match)
705 return -ENODEV;
706 lvds->soc_data = match->data;
707
708 lvds->grf = syscon_regmap_lookup_by_phandle(dev->of_node,
709 "rockchip,grf");
710 if (IS_ERR(lvds->grf)) {
711 DRM_DEV_ERROR(dev, "missing rockchip,grf property\n");
712 return PTR_ERR(lvds->grf);
713 }
714
715 ret = lvds->soc_data->probe(pdev, lvds);
716 if (ret) {
717 DRM_DEV_ERROR(dev, "Platform initialization failed\n");
718 return ret;
719 }
720
721 dev_set_drvdata(dev, lvds);
722
723 ret = component_add(&pdev->dev, &rockchip_lvds_component_ops);
724 if (ret < 0) {
725 DRM_DEV_ERROR(dev, "failed to add component\n");
726 clk_unprepare(lvds->pclk);
727 }
728
729 return ret;
730}
731
732static int rockchip_lvds_remove(struct platform_device *pdev)
733{
734 struct rockchip_lvds *lvds = platform_get_drvdata(pdev);
735
736 component_del(&pdev->dev, &rockchip_lvds_component_ops);
737 clk_unprepare(lvds->pclk);
738
739 return 0;
740}
741
742struct platform_driver rockchip_lvds_driver = {
743 .probe = rockchip_lvds_probe,
744 .remove = rockchip_lvds_remove,
745 .driver = {
746 .name = "rockchip-lvds",
747 .of_match_table = of_match_ptr(rockchip_lvds_dt_ids),
748 },
749};
750
