Lines Matching +full:lvds +full:- +full:encoder
1 // SPDX-License-Identifier: GPL-2.0-only
5 * Mark Yao <mark.yao@rock-chips.com>
6 * Sandy Huang <hjc@rock-chips.com>
39 * struct rockchip_lvds_soc_data - rockchip lvds Soc private data
40 * @probe: LVDS platform probe function
41 * @helper_funcs: LVDS connector helper functions
44 int (*probe)(struct platform_device *pdev, struct rockchip_lvds *lvds);
55 int output; /* rgb lvds or dual lvds output */
61 struct rockchip_encoder encoder; member
70 static inline struct rockchip_lvds *encoder_to_lvds(struct drm_encoder *encoder) in encoder_to_lvds() argument
72 struct rockchip_encoder *rkencoder = to_rockchip_encoder(encoder); in encoder_to_lvds()
74 return container_of(rkencoder, struct rockchip_lvds, encoder); in encoder_to_lvds()
77 static inline void rk3288_writel(struct rockchip_lvds *lvds, u32 offset, in rk3288_writel() argument
80 writel_relaxed(val, lvds->regs + offset); in rk3288_writel()
81 if (lvds->output == DISPLAY_OUTPUT_LVDS) in rk3288_writel()
83 writel_relaxed(val, lvds->regs + offset + RK3288_LVDS_CH1_OFFSET); in rk3288_writel()
88 if (strncmp(s, "jeida-18", 8) == 0) in rockchip_lvds_name_to_format()
90 else if (strncmp(s, "jeida-24", 8) == 0) in rockchip_lvds_name_to_format()
92 else if (strncmp(s, "vesa-24", 7) == 0) in rockchip_lvds_name_to_format()
95 return -EINVAL; in rockchip_lvds_name_to_format()
102 else if (strncmp(s, "lvds", 4) == 0) in rockchip_lvds_name_to_output()
107 return -EINVAL; in rockchip_lvds_name_to_output()
120 struct rockchip_lvds *lvds = connector_to_lvds(connector); in rockchip_lvds_connector_get_modes() local
121 struct drm_panel *panel = lvds->panel; in rockchip_lvds_connector_get_modes()
132 rockchip_lvds_encoder_atomic_check(struct drm_encoder *encoder, in rockchip_lvds_encoder_atomic_check() argument
138 s->output_mode = ROCKCHIP_OUT_MODE_P888; in rockchip_lvds_encoder_atomic_check()
139 s->output_type = DRM_MODE_CONNECTOR_LVDS; in rockchip_lvds_encoder_atomic_check()
144 static int rk3288_lvds_poweron(struct rockchip_lvds *lvds) in rk3288_lvds_poweron() argument
149 ret = clk_enable(lvds->pclk); in rk3288_lvds_poweron()
151 DRM_DEV_ERROR(lvds->dev, "failed to enable lvds pclk %d\n", ret); in rk3288_lvds_poweron()
154 ret = pm_runtime_resume_and_get(lvds->dev); in rk3288_lvds_poweron()
156 DRM_DEV_ERROR(lvds->dev, "failed to get pm runtime: %d\n", ret); in rk3288_lvds_poweron()
157 clk_disable(lvds->pclk); in rk3288_lvds_poweron()
163 if (lvds->output == DISPLAY_OUTPUT_RGB) { in rk3288_lvds_poweron()
166 rk3288_writel(lvds, RK3288_LVDS_CH0_REG0, val); in rk3288_lvds_poweron()
167 rk3288_writel(lvds, RK3288_LVDS_CH0_REG2, in rk3288_lvds_poweron()
169 rk3288_writel(lvds, RK3288_LVDS_CH0_REG4, in rk3288_lvds_poweron()
176 rk3288_writel(lvds, RK3288_LVDS_CH0_REG5, in rk3288_lvds_poweron()
186 rk3288_writel(lvds, RK3288_LVDS_CH0_REG0, val); in rk3288_lvds_poweron()
187 rk3288_writel(lvds, RK3288_LVDS_CH0_REG1, in rk3288_lvds_poweron()
194 rk3288_writel(lvds, RK3288_LVDS_CH0_REG2, in rk3288_lvds_poweron()
203 rk3288_writel(lvds, RK3288_LVDS_CH0_REG4, 0x00); in rk3288_lvds_poweron()
204 rk3288_writel(lvds, RK3288_LVDS_CH0_REG5, 0x00); in rk3288_lvds_poweron()
206 rk3288_writel(lvds, RK3288_LVDS_CH0_REG3, in rk3288_lvds_poweron()
208 rk3288_writel(lvds, RK3288_LVDS_CH0_REGD, in rk3288_lvds_poweron()
210 rk3288_writel(lvds, RK3288_LVDS_CH0_REG20, in rk3288_lvds_poweron()
213 rk3288_writel(lvds, RK3288_LVDS_CFG_REGC, in rk3288_lvds_poweron()
215 rk3288_writel(lvds, RK3288_LVDS_CFG_REG21, in rk3288_lvds_poweron()
221 static void rk3288_lvds_poweroff(struct rockchip_lvds *lvds) in rk3288_lvds_poweroff() argument
226 rk3288_writel(lvds, RK3288_LVDS_CFG_REG21, in rk3288_lvds_poweroff()
228 rk3288_writel(lvds, RK3288_LVDS_CFG_REGC, in rk3288_lvds_poweroff()
232 ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON7, val); in rk3288_lvds_poweroff()
234 DRM_DEV_ERROR(lvds->dev, "Could not write to GRF: %d\n", ret); in rk3288_lvds_poweroff()
236 pm_runtime_put(lvds->dev); in rk3288_lvds_poweroff()
237 clk_disable(lvds->pclk); in rk3288_lvds_poweroff()
240 static int rk3288_lvds_grf_config(struct drm_encoder *encoder, in rk3288_lvds_grf_config() argument
243 struct rockchip_lvds *lvds = encoder_to_lvds(encoder); in rk3288_lvds_grf_config() local
244 u8 pin_hsync = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 1 : 0; in rk3288_lvds_grf_config()
245 u8 pin_dclk = (mode->flags & DRM_MODE_FLAG_PCSYNC) ? 1 : 0; in rk3288_lvds_grf_config()
250 if (lvds->output == DISPLAY_OUTPUT_RGB) in rk3288_lvds_grf_config()
251 if (lvds->pins && !IS_ERR(lvds->pins->default_state)) in rk3288_lvds_grf_config()
252 pinctrl_select_state(lvds->pins->p, in rk3288_lvds_grf_config()
253 lvds->pins->default_state); in rk3288_lvds_grf_config()
254 val = lvds->format | LVDS_CH0_EN; in rk3288_lvds_grf_config()
255 if (lvds->output == DISPLAY_OUTPUT_RGB) in rk3288_lvds_grf_config()
257 else if (lvds->output == DISPLAY_OUTPUT_DUAL_LVDS) in rk3288_lvds_grf_config()
260 if ((mode->htotal - mode->hsync_start) & 0x01) in rk3288_lvds_grf_config()
265 ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON7, val); in rk3288_lvds_grf_config()
267 DRM_DEV_ERROR(lvds->dev, "Could not write to GRF: %d\n", ret); in rk3288_lvds_grf_config()
272 static int rk3288_lvds_set_vop_source(struct rockchip_lvds *lvds, in rk3288_lvds_set_vop_source() argument
273 struct drm_encoder *encoder) in rk3288_lvds_set_vop_source() argument
278 ret = drm_of_encoder_active_endpoint_id(lvds->dev->of_node, encoder); in rk3288_lvds_set_vop_source()
286 ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON6, val); in rk3288_lvds_set_vop_source()
293 static void rk3288_lvds_encoder_enable(struct drm_encoder *encoder) in rk3288_lvds_encoder_enable() argument
295 struct rockchip_lvds *lvds = encoder_to_lvds(encoder); in rk3288_lvds_encoder_enable() local
296 struct drm_display_mode *mode = &encoder->crtc->state->adjusted_mode; in rk3288_lvds_encoder_enable()
299 drm_panel_prepare(lvds->panel); in rk3288_lvds_encoder_enable()
301 ret = rk3288_lvds_poweron(lvds); in rk3288_lvds_encoder_enable()
303 DRM_DEV_ERROR(lvds->dev, "failed to power on LVDS: %d\n", ret); in rk3288_lvds_encoder_enable()
304 drm_panel_unprepare(lvds->panel); in rk3288_lvds_encoder_enable()
308 ret = rk3288_lvds_grf_config(encoder, mode); in rk3288_lvds_encoder_enable()
310 DRM_DEV_ERROR(lvds->dev, "failed to configure LVDS: %d\n", ret); in rk3288_lvds_encoder_enable()
311 drm_panel_unprepare(lvds->panel); in rk3288_lvds_encoder_enable()
315 ret = rk3288_lvds_set_vop_source(lvds, encoder); in rk3288_lvds_encoder_enable()
317 DRM_DEV_ERROR(lvds->dev, "failed to set VOP source: %d\n", ret); in rk3288_lvds_encoder_enable()
318 drm_panel_unprepare(lvds->panel); in rk3288_lvds_encoder_enable()
322 drm_panel_enable(lvds->panel); in rk3288_lvds_encoder_enable()
325 static void rk3288_lvds_encoder_disable(struct drm_encoder *encoder) in rk3288_lvds_encoder_disable() argument
327 struct rockchip_lvds *lvds = encoder_to_lvds(encoder); in rk3288_lvds_encoder_disable() local
329 drm_panel_disable(lvds->panel); in rk3288_lvds_encoder_disable()
330 rk3288_lvds_poweroff(lvds); in rk3288_lvds_encoder_disable()
331 drm_panel_unprepare(lvds->panel); in rk3288_lvds_encoder_disable()
334 static int px30_lvds_poweron(struct rockchip_lvds *lvds) in px30_lvds_poweron() argument
338 ret = pm_runtime_resume_and_get(lvds->dev); in px30_lvds_poweron()
340 DRM_DEV_ERROR(lvds->dev, "failed to get pm runtime: %d\n", ret); in px30_lvds_poweron()
344 /* Enable LVDS mode */ in px30_lvds_poweron()
345 ret = regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1, in px30_lvds_poweron()
349 pm_runtime_put(lvds->dev); in px30_lvds_poweron()
354 static void px30_lvds_poweroff(struct rockchip_lvds *lvds) in px30_lvds_poweroff() argument
356 regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1, in px30_lvds_poweroff()
360 pm_runtime_put(lvds->dev); in px30_lvds_poweroff()
363 static int px30_lvds_grf_config(struct drm_encoder *encoder, in px30_lvds_grf_config() argument
366 struct rockchip_lvds *lvds = encoder_to_lvds(encoder); in px30_lvds_grf_config() local
368 if (lvds->output != DISPLAY_OUTPUT_LVDS) { in px30_lvds_grf_config()
369 DRM_DEV_ERROR(lvds->dev, "Unsupported display output %d\n", in px30_lvds_grf_config()
370 lvds->output); in px30_lvds_grf_config()
371 return -EINVAL; in px30_lvds_grf_config()
375 return regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1, in px30_lvds_grf_config()
376 PX30_LVDS_FORMAT(lvds->format), in px30_lvds_grf_config()
377 PX30_LVDS_FORMAT(lvds->format)); in px30_lvds_grf_config()
380 static int px30_lvds_set_vop_source(struct rockchip_lvds *lvds, in px30_lvds_set_vop_source() argument
381 struct drm_encoder *encoder) in px30_lvds_set_vop_source() argument
385 vop = drm_of_encoder_active_endpoint_id(lvds->dev->of_node, encoder); in px30_lvds_set_vop_source()
389 return regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1, in px30_lvds_set_vop_source()
394 static void px30_lvds_encoder_enable(struct drm_encoder *encoder) in px30_lvds_encoder_enable() argument
396 struct rockchip_lvds *lvds = encoder_to_lvds(encoder); in px30_lvds_encoder_enable() local
397 struct drm_display_mode *mode = &encoder->crtc->state->adjusted_mode; in px30_lvds_encoder_enable()
400 drm_panel_prepare(lvds->panel); in px30_lvds_encoder_enable()
402 ret = px30_lvds_poweron(lvds); in px30_lvds_encoder_enable()
404 DRM_DEV_ERROR(lvds->dev, "failed to power on LVDS: %d\n", ret); in px30_lvds_encoder_enable()
405 drm_panel_unprepare(lvds->panel); in px30_lvds_encoder_enable()
409 ret = px30_lvds_grf_config(encoder, mode); in px30_lvds_encoder_enable()
411 DRM_DEV_ERROR(lvds->dev, "failed to configure LVDS: %d\n", ret); in px30_lvds_encoder_enable()
412 drm_panel_unprepare(lvds->panel); in px30_lvds_encoder_enable()
416 ret = px30_lvds_set_vop_source(lvds, encoder); in px30_lvds_encoder_enable()
418 DRM_DEV_ERROR(lvds->dev, "failed to set VOP source: %d\n", ret); in px30_lvds_encoder_enable()
419 drm_panel_unprepare(lvds->panel); in px30_lvds_encoder_enable()
423 drm_panel_enable(lvds->panel); in px30_lvds_encoder_enable()
426 static void px30_lvds_encoder_disable(struct drm_encoder *encoder) in px30_lvds_encoder_disable() argument
428 struct rockchip_lvds *lvds = encoder_to_lvds(encoder); in px30_lvds_encoder_disable() local
430 drm_panel_disable(lvds->panel); in px30_lvds_encoder_disable()
431 px30_lvds_poweroff(lvds); in px30_lvds_encoder_disable()
432 drm_panel_unprepare(lvds->panel); in px30_lvds_encoder_disable()
450 struct rockchip_lvds *lvds) in rk3288_lvds_probe() argument
454 lvds->regs = devm_platform_ioremap_resource(pdev, 0); in rk3288_lvds_probe()
455 if (IS_ERR(lvds->regs)) in rk3288_lvds_probe()
456 return PTR_ERR(lvds->regs); in rk3288_lvds_probe()
458 lvds->pclk = devm_clk_get(lvds->dev, "pclk_lvds"); in rk3288_lvds_probe()
459 if (IS_ERR(lvds->pclk)) { in rk3288_lvds_probe()
460 DRM_DEV_ERROR(lvds->dev, "could not get pclk_lvds\n"); in rk3288_lvds_probe()
461 return PTR_ERR(lvds->pclk); in rk3288_lvds_probe()
464 lvds->pins = devm_kzalloc(lvds->dev, sizeof(*lvds->pins), in rk3288_lvds_probe()
466 if (!lvds->pins) in rk3288_lvds_probe()
467 return -ENOMEM; in rk3288_lvds_probe()
469 lvds->pins->p = devm_pinctrl_get(lvds->dev); in rk3288_lvds_probe()
470 if (IS_ERR(lvds->pins->p)) { in rk3288_lvds_probe()
471 DRM_DEV_ERROR(lvds->dev, "no pinctrl handle\n"); in rk3288_lvds_probe()
472 devm_kfree(lvds->dev, lvds->pins); in rk3288_lvds_probe()
473 lvds->pins = NULL; in rk3288_lvds_probe()
475 lvds->pins->default_state = in rk3288_lvds_probe()
476 pinctrl_lookup_state(lvds->pins->p, "lcdc"); in rk3288_lvds_probe()
477 if (IS_ERR(lvds->pins->default_state)) { in rk3288_lvds_probe()
478 DRM_DEV_ERROR(lvds->dev, "no default pinctrl state\n"); in rk3288_lvds_probe()
479 devm_kfree(lvds->dev, lvds->pins); in rk3288_lvds_probe()
480 lvds->pins = NULL; in rk3288_lvds_probe()
484 ret = clk_prepare(lvds->pclk); in rk3288_lvds_probe()
486 DRM_DEV_ERROR(lvds->dev, "failed to prepare pclk_lvds\n"); in rk3288_lvds_probe()
494 struct rockchip_lvds *lvds) in px30_lvds_probe() argument
499 ret = regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1, in px30_lvds_probe()
506 lvds->dphy = devm_phy_get(&pdev->dev, "dphy"); in px30_lvds_probe()
507 if (IS_ERR(lvds->dphy)) in px30_lvds_probe()
508 return PTR_ERR(lvds->dphy); in px30_lvds_probe()
510 ret = phy_init(lvds->dphy); in px30_lvds_probe()
514 ret = phy_set_mode(lvds->dphy, PHY_MODE_LVDS); in px30_lvds_probe()
518 return phy_power_on(lvds->dphy); in px30_lvds_probe()
533 .compatible = "rockchip,rk3288-lvds",
537 .compatible = "rockchip,px30-lvds",
547 struct rockchip_lvds *lvds = dev_get_drvdata(dev); in rockchip_lvds_bind() local
549 struct drm_encoder *encoder; in rockchip_lvds_bind() local
557 lvds->drm_dev = drm_dev; in rockchip_lvds_bind()
558 port = of_graph_get_port_by_id(dev->of_node, 1); in rockchip_lvds_bind()
561 "can't found port point, please init lvds panel port!\n"); in rockchip_lvds_bind()
562 return -EINVAL; in rockchip_lvds_bind()
567 ret = drm_of_find_panel_or_bridge(dev->of_node, 1, endpoint_id, in rockchip_lvds_bind()
568 &lvds->panel, &lvds->bridge); in rockchip_lvds_bind()
575 DRM_DEV_ERROR(dev, "lvds port does not have any children\n"); in rockchip_lvds_bind()
576 ret = -EINVAL; in rockchip_lvds_bind()
582 if (lvds->panel) in rockchip_lvds_bind()
583 remote = lvds->panel->dev->of_node; in rockchip_lvds_bind()
585 remote = lvds->bridge->of_node; in rockchip_lvds_bind()
586 if (of_property_read_string(dev->of_node, "rockchip,output", &name)) in rockchip_lvds_bind()
588 lvds->output = DISPLAY_OUTPUT_RGB; in rockchip_lvds_bind()
590 lvds->output = rockchip_lvds_name_to_output(name); in rockchip_lvds_bind()
592 if (lvds->output < 0) { in rockchip_lvds_bind()
594 ret = lvds->output; in rockchip_lvds_bind()
598 if (of_property_read_string(remote, "data-mapping", &name)) in rockchip_lvds_bind()
600 lvds->format = LVDS_VESA_18; in rockchip_lvds_bind()
602 lvds->format = rockchip_lvds_name_to_format(name); in rockchip_lvds_bind()
604 if (lvds->format < 0) { in rockchip_lvds_bind()
605 DRM_DEV_ERROR(dev, "invalid data-mapping format [%s]\n", name); in rockchip_lvds_bind()
606 ret = lvds->format; in rockchip_lvds_bind()
610 encoder = &lvds->encoder.encoder; in rockchip_lvds_bind()
611 encoder->possible_crtcs = drm_of_find_possible_crtcs(drm_dev, in rockchip_lvds_bind()
612 dev->of_node); in rockchip_lvds_bind()
614 ret = drm_simple_encoder_init(drm_dev, encoder, DRM_MODE_ENCODER_LVDS); in rockchip_lvds_bind()
616 DRM_DEV_ERROR(drm_dev->dev, in rockchip_lvds_bind()
617 "failed to initialize encoder: %d\n", ret); in rockchip_lvds_bind()
621 drm_encoder_helper_add(encoder, lvds->soc_data->helper_funcs); in rockchip_lvds_bind()
622 connector = &lvds->connector; in rockchip_lvds_bind()
624 if (lvds->panel) { in rockchip_lvds_bind()
625 connector->dpms = DRM_MODE_DPMS_OFF; in rockchip_lvds_bind()
630 DRM_DEV_ERROR(drm_dev->dev, in rockchip_lvds_bind()
638 ret = drm_bridge_attach(encoder, lvds->bridge, NULL, in rockchip_lvds_bind()
643 connector = drm_bridge_connector_init(lvds->drm_dev, encoder); in rockchip_lvds_bind()
645 DRM_DEV_ERROR(drm_dev->dev, in rockchip_lvds_bind()
653 ret = drm_connector_attach_encoder(connector, encoder); in rockchip_lvds_bind()
655 DRM_DEV_ERROR(drm_dev->dev, in rockchip_lvds_bind()
656 "failed to attach encoder: %d\n", ret); in rockchip_lvds_bind()
669 drm_encoder_cleanup(encoder); in rockchip_lvds_bind()
681 struct rockchip_lvds *lvds = dev_get_drvdata(dev); in rockchip_lvds_unbind() local
684 encoder_funcs = lvds->soc_data->helper_funcs; in rockchip_lvds_unbind()
685 encoder_funcs->disable(&lvds->encoder.encoder); in rockchip_lvds_unbind()
687 drm_connector_cleanup(&lvds->connector); in rockchip_lvds_unbind()
688 drm_encoder_cleanup(&lvds->encoder.encoder); in rockchip_lvds_unbind()
698 struct device *dev = &pdev->dev; in rockchip_lvds_probe()
699 struct rockchip_lvds *lvds; in rockchip_lvds_probe() local
703 if (!dev->of_node) in rockchip_lvds_probe()
704 return -ENODEV; in rockchip_lvds_probe()
706 lvds = devm_kzalloc(&pdev->dev, sizeof(*lvds), GFP_KERNEL); in rockchip_lvds_probe()
707 if (!lvds) in rockchip_lvds_probe()
708 return -ENOMEM; in rockchip_lvds_probe()
710 lvds->dev = dev; in rockchip_lvds_probe()
711 match = of_match_node(rockchip_lvds_dt_ids, dev->of_node); in rockchip_lvds_probe()
713 return -ENODEV; in rockchip_lvds_probe()
714 lvds->soc_data = match->data; in rockchip_lvds_probe()
716 lvds->grf = syscon_regmap_lookup_by_phandle(dev->of_node, in rockchip_lvds_probe()
718 if (IS_ERR(lvds->grf)) { in rockchip_lvds_probe()
720 return PTR_ERR(lvds->grf); in rockchip_lvds_probe()
723 ret = lvds->soc_data->probe(pdev, lvds); in rockchip_lvds_probe()
729 dev_set_drvdata(dev, lvds); in rockchip_lvds_probe()
731 ret = component_add(&pdev->dev, &rockchip_lvds_component_ops); in rockchip_lvds_probe()
734 clk_unprepare(lvds->pclk); in rockchip_lvds_probe()
742 struct rockchip_lvds *lvds = platform_get_drvdata(pdev); in rockchip_lvds_remove() local
744 component_del(&pdev->dev, &rockchip_lvds_component_ops); in rockchip_lvds_remove()
745 clk_unprepare(lvds->pclk); in rockchip_lvds_remove()
752 .name = "rockchip-lvds",