drm/rockchip/rockchip_lvds.c

38  * struct rockchip_lvds_soc_data - rockchip lvds Soc private data
43 	int (*probe)(struct platform_device *pdev, struct rockchip_lvds *lvds);
54 	int output; /* rgb lvds or dual lvds output */
75 static inline void rk3288_writel(struct rockchip_lvds *lvds, u32 offset,
78 	writel_relaxed(val, lvds->regs + offset);
79 	if (lvds->output == DISPLAY_OUTPUT_LVDS)
81 	writel_relaxed(val, lvds->regs + offset + RK3288_LVDS_CH1_OFFSET);
100 	else if (strncmp(s, "lvds", 4) == 0)
111 	struct rockchip_lvds *lvds = brige_to_lvds(bridge);
112 	struct drm_panel *panel = lvds->panel;
138 static int rk3288_lvds_poweron(struct rockchip_lvds *lvds)
143 	ret = clk_enable(lvds->pclk);
145 		DRM_DEV_ERROR(lvds->dev, "failed to enable lvds pclk %d\n", ret);
148 	ret = pm_runtime_resume_and_get(lvds->dev);
150 		DRM_DEV_ERROR(lvds->dev, "failed to get pm runtime: %d\n", ret);
151 		clk_disable(lvds->pclk);
157 	if (lvds->output == DISPLAY_OUTPUT_RGB) {
160 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG0, val);
161 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG2,
163 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG4,
170 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG5,
180 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG0, val);
181 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG1,
188 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG2,
197 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG4, 0x00);
198 		rk3288_writel(lvds, RK3288_LVDS_CH0_REG5, 0x00);
200 	rk3288_writel(lvds, RK3288_LVDS_CH0_REG3,
202 	rk3288_writel(lvds, RK3288_LVDS_CH0_REGD,
204 	rk3288_writel(lvds, RK3288_LVDS_CH0_REG20,
207 	rk3288_writel(lvds, RK3288_LVDS_CFG_REGC,
209 	rk3288_writel(lvds, RK3288_LVDS_CFG_REG21,
215 static void rk3288_lvds_poweroff(struct rockchip_lvds *lvds)
220 	rk3288_writel(lvds, RK3288_LVDS_CFG_REG21,
222 	rk3288_writel(lvds, RK3288_LVDS_CFG_REGC,
226 	ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON7, val);
228 		DRM_DEV_ERROR(lvds->dev, "Could not write to GRF: %d\n", ret);
230 	pm_runtime_put(lvds->dev);
231 	clk_disable(lvds->pclk);
237 	struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
244 	if (lvds->output == DISPLAY_OUTPUT_RGB)
245 		if (lvds->pins && !IS_ERR(lvds->pins->default_state))
246 			pinctrl_select_state(lvds->pins->p,
247 					     lvds->pins->default_state);
248 	val = lvds->format | LVDS_CH0_EN;
249 	if (lvds->output == DISPLAY_OUTPUT_RGB)
251 	else if (lvds->output == DISPLAY_OUTPUT_DUAL_LVDS)
259 	ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON7, val);
261 		DRM_DEV_ERROR(lvds->dev, "Could not write to GRF: %d\n", ret);
266 static int rk3288_lvds_set_vop_source(struct rockchip_lvds *lvds,
272 	ret = drm_of_encoder_active_endpoint_id(lvds->dev->of_node, encoder);
280 	ret = regmap_write(lvds->grf, RK3288_LVDS_GRF_SOC_CON6, val);
289 	struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
293 	drm_panel_prepare(lvds->panel);
295 	ret = rk3288_lvds_poweron(lvds);
297 		DRM_DEV_ERROR(lvds->dev, "failed to power on LVDS: %d\n", ret);
298 		drm_panel_unprepare(lvds->panel);
304 		DRM_DEV_ERROR(lvds->dev, "failed to configure LVDS: %d\n", ret);
305 		drm_panel_unprepare(lvds->panel);
309 	ret = rk3288_lvds_set_vop_source(lvds, encoder);
311 		DRM_DEV_ERROR(lvds->dev, "failed to set VOP source: %d\n", ret);
312 		drm_panel_unprepare(lvds->panel);
316 	drm_panel_enable(lvds->panel);
321 	struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
323 	drm_panel_disable(lvds->panel);
324 	rk3288_lvds_poweroff(lvds);
325 	drm_panel_unprepare(lvds->panel);
328 static int px30_lvds_poweron(struct rockchip_lvds *lvds)
332 	ret = pm_runtime_resume_and_get(lvds->dev);
334 		DRM_DEV_ERROR(lvds->dev, "failed to get pm runtime: %d\n", ret);
339 	ret = regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
343 		pm_runtime_put(lvds->dev);
348 static void px30_lvds_poweroff(struct rockchip_lvds *lvds)
350 	regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
354 	pm_runtime_put(lvds->dev);
360 	struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
362 	if (lvds->output != DISPLAY_OUTPUT_LVDS) {
363 		DRM_DEV_ERROR(lvds->dev, "Unsupported display output %d\n",
364 			      lvds->output);
369 	return regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
370 				  PX30_LVDS_FORMAT(lvds->format),
371 				  PX30_LVDS_FORMAT(lvds->format));
374 static int px30_lvds_set_vop_source(struct rockchip_lvds *lvds,
379 	vop = drm_of_encoder_active_endpoint_id(lvds->dev->of_node, encoder);
383 	return regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
390 	struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
394 	drm_panel_prepare(lvds->panel);
396 	ret = px30_lvds_poweron(lvds);
398 		DRM_DEV_ERROR(lvds->dev, "failed to power on LVDS: %d\n", ret);
399 		drm_panel_unprepare(lvds->panel);
405 		DRM_DEV_ERROR(lvds->dev, "failed to configure LVDS: %d\n", ret);
406 		drm_panel_unprepare(lvds->panel);
410 	ret = px30_lvds_set_vop_source(lvds, encoder);
412 		DRM_DEV_ERROR(lvds->dev, "failed to set VOP source: %d\n", ret);
413 		drm_panel_unprepare(lvds->panel);
417 	drm_panel_enable(lvds->panel);
422 	struct rockchip_lvds *lvds = encoder_to_lvds(encoder);
424 	drm_panel_disable(lvds->panel);
425 	px30_lvds_poweroff(lvds);
426 	drm_panel_unprepare(lvds->panel);
444 			     struct rockchip_lvds *lvds)
446 	lvds->regs = devm_platform_ioremap_resource(pdev, 0);
447 	if (IS_ERR(lvds->regs))
448 		return PTR_ERR(lvds->regs);
450 	lvds->pclk = devm_clk_get_prepared(lvds->dev, "pclk_lvds");
451 	if (IS_ERR(lvds->pclk))
452 		return dev_err_probe(lvds->dev, PTR_ERR(lvds->pclk),
455 	lvds->pins = devm_kzalloc(lvds->dev, sizeof(*lvds->pins),
457 	if (!lvds->pins)
460 	lvds->pins->p = devm_pinctrl_get(lvds->dev);
461 	if (IS_ERR(lvds->pins->p)) {
462 		dev_warn(lvds->dev, "no pinctrl handle\n");
463 		devm_kfree(lvds->dev, lvds->pins);
464 		lvds->pins = NULL;
466 		lvds->pins->default_state =
467 			pinctrl_lookup_state(lvds->pins->p, "lcdc");
468 		if (IS_ERR(lvds->pins->default_state)) {
469 			dev_warn(lvds->dev, "no default pinctrl state\n");
470 			devm_kfree(lvds->dev, lvds->pins);
471 			lvds->pins = NULL;
479 			   struct rockchip_lvds *lvds)
484 	ret =  regmap_update_bits(lvds->grf, PX30_LVDS_GRF_PD_VO_CON1,
491 	lvds->dphy = devm_phy_get(&pdev->dev, "dphy");
492 	if (IS_ERR(lvds->dphy))
493 		return PTR_ERR(lvds->dphy);
495 	ret = phy_init(lvds->dphy);
499 	ret = phy_set_mode(lvds->dphy, PHY_MODE_LVDS);
503 	return phy_power_on(lvds->dphy);
518 		.compatible = "rockchip,rk3288-lvds",
522 		.compatible = "rockchip,px30-lvds",
532 	struct rockchip_lvds *lvds = dev_get_drvdata(dev);
542 	lvds->drm_dev = drm_dev;
546 				     "can't found port point, please init lvds panel port!\n");
552 						  &lvds->panel, &lvds->bridge);
559 		ret = dev_err_probe(dev, -EINVAL, "lvds port does not have any children\n");
565 	if (lvds->panel)
566 		remote = lvds->panel->dev->of_node;
568 		remote = lvds->bridge->of_node;
571 		lvds->output = DISPLAY_OUTPUT_RGB;
573 		lvds->output = rockchip_lvds_name_to_output(name);
575 	if (lvds->output < 0) {
576 		ret = dev_err_probe(dev, lvds->output, "invalid output type [%s]\n", name);
582 		lvds->format = LVDS_VESA_18;
584 		lvds->format = rockchip_lvds_name_to_format(name);
586 	if (lvds->format < 0) {
587 		ret = dev_err_probe(dev, lvds->format,
592 	encoder = &lvds->encoder.encoder;
603 	drm_encoder_helper_add(encoder, lvds->soc_data->helper_funcs);
605 	if (lvds->panel) {
606 		lvds->bridge = drm_panel_bridge_add_typed(lvds->panel, DRM_MODE_CONNECTOR_LVDS);
607 		if (IS_ERR(lvds->bridge)) {
608 			ret = PTR_ERR(lvds->bridge);
613 	if (lvds->bridge) {
614 		lvds->bridge->driver_private = lvds;
615 		lvds->bridge->ops = DRM_BRIDGE_OP_MODES;
616 		lvds->bridge->funcs = &rockchip_lvds_bridge_funcs;
618 		ret = drm_bridge_attach(encoder, lvds->bridge, NULL, DRM_BRIDGE_ATTACH_NO_CONNECTOR);
622 		connector = drm_bridge_connector_init(lvds->drm_dev, encoder);
645 	drm_panel_bridge_remove(lvds->bridge);
659 	struct rockchip_lvds *lvds = dev_get_drvdata(dev);
662 	encoder_funcs = lvds->soc_data->helper_funcs;
663 	encoder_funcs->disable(&lvds->encoder.encoder);
675 	struct rockchip_lvds *lvds;
682 	lvds = devm_kzalloc(&pdev->dev, sizeof(*lvds), GFP_KERNEL);
683 	if (!lvds)
686 	lvds->dev = dev;
690 	lvds->soc_data = match->data;
692 	lvds->grf = syscon_regmap_lookup_by_phandle(dev->of_node,
694 	if (IS_ERR(lvds->grf))
695 		return dev_err_probe(dev, PTR_ERR(lvds->grf), "missing rockchip,grf property\n");
697 	ret = lvds->soc_data->probe(pdev, lvds);
701 	dev_set_drvdata(dev, lvds);
719 		   .name = "rockchip-lvds",