1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd
7 #include <linux/mfd/syscon.h>
8 #include <linux/module.h>
9 #include <linux/platform_device.h>
10 #include <linux/phy/phy.h>
11 #include <linux/regmap.h>
12 #include <linux/regulator/consumer.h>
14 #include <drm/bridge/dw_hdmi.h>
15 #include <drm/drm_edid.h>
16 #include <drm/drm_of.h>
17 #include <drm/drm_probe_helper.h>
18 #include <drm/drm_simple_kms_helper.h>
20 #include "rockchip_drm_drv.h"
21 #include "rockchip_drm_vop.h"
23 #define RK3228_GRF_SOC_CON2 0x0408
24 #define RK3228_HDMI_SDAIN_MSK BIT(14)
25 #define RK3228_HDMI_SCLIN_MSK BIT(13)
26 #define RK3228_GRF_SOC_CON6 0x0418
27 #define RK3228_HDMI_HPD_VSEL BIT(6)
28 #define RK3228_HDMI_SDA_VSEL BIT(5)
29 #define RK3228_HDMI_SCL_VSEL BIT(4)
31 #define RK3288_GRF_SOC_CON6 0x025C
32 #define RK3288_HDMI_LCDC_SEL BIT(4)
33 #define RK3328_GRF_SOC_CON2 0x0408
35 #define RK3328_HDMI_SDAIN_MSK BIT(11)
36 #define RK3328_HDMI_SCLIN_MSK BIT(10)
37 #define RK3328_HDMI_HPD_IOE BIT(2)
38 #define RK3328_GRF_SOC_CON3 0x040c
39 /* need to be unset if hdmi or i2c should control voltage */
40 #define RK3328_HDMI_SDA5V_GRF BIT(15)
41 #define RK3328_HDMI_SCL5V_GRF BIT(14)
42 #define RK3328_HDMI_HPD5V_GRF BIT(13)
43 #define RK3328_HDMI_CEC5V_GRF BIT(12)
44 #define RK3328_GRF_SOC_CON4 0x0410
45 #define RK3328_HDMI_HPD_SARADC BIT(13)
46 #define RK3328_HDMI_CEC_5V BIT(11)
47 #define RK3328_HDMI_SDA_5V BIT(10)
48 #define RK3328_HDMI_SCL_5V BIT(9)
49 #define RK3328_HDMI_HPD_5V BIT(8)
51 #define RK3399_GRF_SOC_CON20 0x6250
52 #define RK3399_HDMI_LCDC_SEL BIT(6)
54 #define RK3568_GRF_VO_CON1 0x0364
55 #define RK3568_HDMI_SDAIN_MSK BIT(15)
56 #define RK3568_HDMI_SCLIN_MSK BIT(14)
58 #define HIWORD_UPDATE(val, mask) (val | (mask) << 16)
61 * struct rockchip_hdmi_chip_data - splite the grf setting of kind of chips
62 * @lcdsel_grf_reg: grf register offset of lcdc select
63 * @lcdsel_big: reg value of selecting vop big for HDMI
64 * @lcdsel_lit: reg value of selecting vop little for HDMI
66 struct rockchip_hdmi_chip_data {
72 struct rockchip_hdmi {
74 struct regmap *regmap;
75 struct rockchip_encoder encoder;
76 const struct rockchip_hdmi_chip_data *chip_data;
77 const struct dw_hdmi_plat_data *plat_data;
81 struct regulator *avdd_0v9;
82 struct regulator *avdd_1v8;
86 static struct rockchip_hdmi *to_rockchip_hdmi(struct drm_encoder *encoder)
88 struct rockchip_encoder *rkencoder = to_rockchip_encoder(encoder);
90 return container_of(rkencoder, struct rockchip_hdmi, encoder);
93 static const struct dw_hdmi_mpll_config rockchip_mpll_cfg[] = {
179 static const struct dw_hdmi_curr_ctrl rockchip_cur_ctr[] = {
180 /* pixelclk bpp8 bpp10 bpp12 */
182 40000000, { 0x0018, 0x0018, 0x0018 },
184 65000000, { 0x0028, 0x0028, 0x0028 },
186 66000000, { 0x0038, 0x0038, 0x0038 },
188 74250000, { 0x0028, 0x0038, 0x0038 },
190 83500000, { 0x0028, 0x0038, 0x0038 },
192 146250000, { 0x0038, 0x0038, 0x0038 },
194 148500000, { 0x0000, 0x0038, 0x0038 },
196 600000000, { 0x0000, 0x0000, 0x0000 },
198 ~0UL, { 0x0000, 0x0000, 0x0000},
202 static const struct dw_hdmi_phy_config rockchip_phy_config[] = {
203 /*pixelclk symbol term vlev*/
204 { 74250000, 0x8009, 0x0004, 0x0272},
205 { 148500000, 0x802b, 0x0004, 0x028d},
206 { 297000000, 0x8039, 0x0005, 0x028d},
207 { ~0UL, 0x0000, 0x0000, 0x0000}
210 static int rockchip_hdmi_parse_dt(struct rockchip_hdmi *hdmi)
212 struct device_node *np = hdmi->dev->of_node;
214 hdmi->regmap = syscon_regmap_lookup_by_phandle(np, "rockchip,grf");
215 if (IS_ERR(hdmi->regmap)) {
216 DRM_DEV_ERROR(hdmi->dev, "Unable to get rockchip,grf\n");
217 return PTR_ERR(hdmi->regmap);
220 hdmi->ref_clk = devm_clk_get_optional(hdmi->dev, "ref");
222 hdmi->ref_clk = devm_clk_get_optional(hdmi->dev, "vpll");
224 if (PTR_ERR(hdmi->ref_clk) == -EPROBE_DEFER) {
225 return -EPROBE_DEFER;
226 } else if (IS_ERR(hdmi->ref_clk)) {
227 DRM_DEV_ERROR(hdmi->dev, "failed to get reference clock\n");
228 return PTR_ERR(hdmi->ref_clk);
231 hdmi->grf_clk = devm_clk_get(hdmi->dev, "grf");
232 if (PTR_ERR(hdmi->grf_clk) == -ENOENT) {
233 hdmi->grf_clk = NULL;
234 } else if (PTR_ERR(hdmi->grf_clk) == -EPROBE_DEFER) {
235 return -EPROBE_DEFER;
236 } else if (IS_ERR(hdmi->grf_clk)) {
237 DRM_DEV_ERROR(hdmi->dev, "failed to get grf clock\n");
238 return PTR_ERR(hdmi->grf_clk);
241 hdmi->avdd_0v9 = devm_regulator_get(hdmi->dev, "avdd-0v9");
242 if (IS_ERR(hdmi->avdd_0v9))
243 return PTR_ERR(hdmi->avdd_0v9);
245 hdmi->avdd_1v8 = devm_regulator_get(hdmi->dev, "avdd-1v8");
246 if (IS_ERR(hdmi->avdd_1v8))
247 return PTR_ERR(hdmi->avdd_1v8);
252 static enum drm_mode_status
253 dw_hdmi_rockchip_mode_valid(struct dw_hdmi *dw_hdmi, void *data,
254 const struct drm_display_info *info,
255 const struct drm_display_mode *mode)
257 struct rockchip_hdmi *hdmi = data;
258 const struct dw_hdmi_mpll_config *mpll_cfg = rockchip_mpll_cfg;
259 int pclk = mode->clock * 1000;
260 bool exact_match = hdmi->plat_data->phy_force_vendor;
264 int rpclk = clk_round_rate(hdmi->ref_clk, pclk);
266 if (abs(rpclk - pclk) > pclk / 1000)
270 for (i = 0; mpll_cfg[i].mpixelclock != (~0UL); i++) {
272 * For vendor specific phys force an exact match of the pixelclock
273 * to preserve the original behaviour of the driver.
275 if (exact_match && pclk == mpll_cfg[i].mpixelclock)
278 * The Synopsys phy can work with pixelclocks up to the value given
279 * in the corresponding mpll_cfg entry.
281 if (!exact_match && pclk <= mpll_cfg[i].mpixelclock)
288 static void dw_hdmi_rockchip_encoder_disable(struct drm_encoder *encoder)
293 dw_hdmi_rockchip_encoder_mode_fixup(struct drm_encoder *encoder,
294 const struct drm_display_mode *mode,
295 struct drm_display_mode *adj_mode)
300 static void dw_hdmi_rockchip_encoder_mode_set(struct drm_encoder *encoder,
301 struct drm_display_mode *mode,
302 struct drm_display_mode *adj_mode)
304 struct rockchip_hdmi *hdmi = to_rockchip_hdmi(encoder);
306 clk_set_rate(hdmi->ref_clk, adj_mode->clock * 1000);
309 static void dw_hdmi_rockchip_encoder_enable(struct drm_encoder *encoder)
311 struct rockchip_hdmi *hdmi = to_rockchip_hdmi(encoder);
315 if (hdmi->chip_data->lcdsel_grf_reg < 0)
318 ret = drm_of_encoder_active_endpoint_id(hdmi->dev->of_node, encoder);
320 val = hdmi->chip_data->lcdsel_lit;
322 val = hdmi->chip_data->lcdsel_big;
324 ret = clk_prepare_enable(hdmi->grf_clk);
326 DRM_DEV_ERROR(hdmi->dev, "failed to enable grfclk %d\n", ret);
330 ret = regmap_write(hdmi->regmap, hdmi->chip_data->lcdsel_grf_reg, val);
332 DRM_DEV_ERROR(hdmi->dev, "Could not write to GRF: %d\n", ret);
334 clk_disable_unprepare(hdmi->grf_clk);
335 DRM_DEV_DEBUG(hdmi->dev, "vop %s output to hdmi\n",
336 ret ? "LIT" : "BIG");
340 dw_hdmi_rockchip_encoder_atomic_check(struct drm_encoder *encoder,
341 struct drm_crtc_state *crtc_state,
342 struct drm_connector_state *conn_state)
344 struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
346 s->output_mode = ROCKCHIP_OUT_MODE_AAAA;
347 s->output_type = DRM_MODE_CONNECTOR_HDMIA;
352 static const struct drm_encoder_helper_funcs dw_hdmi_rockchip_encoder_helper_funcs = {
353 .mode_fixup = dw_hdmi_rockchip_encoder_mode_fixup,
354 .mode_set = dw_hdmi_rockchip_encoder_mode_set,
355 .enable = dw_hdmi_rockchip_encoder_enable,
356 .disable = dw_hdmi_rockchip_encoder_disable,
357 .atomic_check = dw_hdmi_rockchip_encoder_atomic_check,
360 static int dw_hdmi_rockchip_genphy_init(struct dw_hdmi *dw_hdmi, void *data,
361 const struct drm_display_info *display,
362 const struct drm_display_mode *mode)
364 struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
366 return phy_power_on(hdmi->phy);
369 static void dw_hdmi_rockchip_genphy_disable(struct dw_hdmi *dw_hdmi, void *data)
371 struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
373 phy_power_off(hdmi->phy);
376 static void dw_hdmi_rk3228_setup_hpd(struct dw_hdmi *dw_hdmi, void *data)
378 struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
380 dw_hdmi_phy_setup_hpd(dw_hdmi, data);
382 regmap_write(hdmi->regmap,
384 HIWORD_UPDATE(RK3228_HDMI_HPD_VSEL | RK3228_HDMI_SDA_VSEL |
385 RK3228_HDMI_SCL_VSEL,
386 RK3228_HDMI_HPD_VSEL | RK3228_HDMI_SDA_VSEL |
387 RK3228_HDMI_SCL_VSEL));
389 regmap_write(hdmi->regmap,
391 HIWORD_UPDATE(RK3228_HDMI_SDAIN_MSK | RK3228_HDMI_SCLIN_MSK,
392 RK3228_HDMI_SDAIN_MSK | RK3228_HDMI_SCLIN_MSK));
395 static enum drm_connector_status
396 dw_hdmi_rk3328_read_hpd(struct dw_hdmi *dw_hdmi, void *data)
398 struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
399 enum drm_connector_status status;
401 status = dw_hdmi_phy_read_hpd(dw_hdmi, data);
403 if (status == connector_status_connected)
404 regmap_write(hdmi->regmap,
406 HIWORD_UPDATE(RK3328_HDMI_SDA_5V | RK3328_HDMI_SCL_5V,
407 RK3328_HDMI_SDA_5V | RK3328_HDMI_SCL_5V));
409 regmap_write(hdmi->regmap,
411 HIWORD_UPDATE(0, RK3328_HDMI_SDA_5V |
412 RK3328_HDMI_SCL_5V));
416 static void dw_hdmi_rk3328_setup_hpd(struct dw_hdmi *dw_hdmi, void *data)
418 struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
420 dw_hdmi_phy_setup_hpd(dw_hdmi, data);
422 /* Enable and map pins to 3V grf-controlled io-voltage */
423 regmap_write(hdmi->regmap,
425 HIWORD_UPDATE(0, RK3328_HDMI_HPD_SARADC | RK3328_HDMI_CEC_5V |
426 RK3328_HDMI_SDA_5V | RK3328_HDMI_SCL_5V |
427 RK3328_HDMI_HPD_5V));
428 regmap_write(hdmi->regmap,
430 HIWORD_UPDATE(0, RK3328_HDMI_SDA5V_GRF | RK3328_HDMI_SCL5V_GRF |
431 RK3328_HDMI_HPD5V_GRF |
432 RK3328_HDMI_CEC5V_GRF));
433 regmap_write(hdmi->regmap,
435 HIWORD_UPDATE(RK3328_HDMI_SDAIN_MSK | RK3328_HDMI_SCLIN_MSK,
436 RK3328_HDMI_SDAIN_MSK | RK3328_HDMI_SCLIN_MSK |
437 RK3328_HDMI_HPD_IOE));
440 static const struct dw_hdmi_phy_ops rk3228_hdmi_phy_ops = {
441 .init = dw_hdmi_rockchip_genphy_init,
442 .disable = dw_hdmi_rockchip_genphy_disable,
443 .read_hpd = dw_hdmi_phy_read_hpd,
444 .update_hpd = dw_hdmi_phy_update_hpd,
445 .setup_hpd = dw_hdmi_rk3228_setup_hpd,
448 static struct rockchip_hdmi_chip_data rk3228_chip_data = {
449 .lcdsel_grf_reg = -1,
452 static const struct dw_hdmi_plat_data rk3228_hdmi_drv_data = {
453 .mode_valid = dw_hdmi_rockchip_mode_valid,
454 .mpll_cfg = rockchip_mpll_cfg,
455 .cur_ctr = rockchip_cur_ctr,
456 .phy_config = rockchip_phy_config,
457 .phy_data = &rk3228_chip_data,
458 .phy_ops = &rk3228_hdmi_phy_ops,
459 .phy_name = "inno_dw_hdmi_phy2",
460 .phy_force_vendor = true,
463 static struct rockchip_hdmi_chip_data rk3288_chip_data = {
464 .lcdsel_grf_reg = RK3288_GRF_SOC_CON6,
465 .lcdsel_big = HIWORD_UPDATE(0, RK3288_HDMI_LCDC_SEL),
466 .lcdsel_lit = HIWORD_UPDATE(RK3288_HDMI_LCDC_SEL, RK3288_HDMI_LCDC_SEL),
469 static const struct dw_hdmi_plat_data rk3288_hdmi_drv_data = {
470 .mode_valid = dw_hdmi_rockchip_mode_valid,
471 .mpll_cfg = rockchip_mpll_cfg,
472 .cur_ctr = rockchip_cur_ctr,
473 .phy_config = rockchip_phy_config,
474 .phy_data = &rk3288_chip_data,
477 static const struct dw_hdmi_phy_ops rk3328_hdmi_phy_ops = {
478 .init = dw_hdmi_rockchip_genphy_init,
479 .disable = dw_hdmi_rockchip_genphy_disable,
480 .read_hpd = dw_hdmi_rk3328_read_hpd,
481 .update_hpd = dw_hdmi_phy_update_hpd,
482 .setup_hpd = dw_hdmi_rk3328_setup_hpd,
485 static struct rockchip_hdmi_chip_data rk3328_chip_data = {
486 .lcdsel_grf_reg = -1,
489 static const struct dw_hdmi_plat_data rk3328_hdmi_drv_data = {
490 .mode_valid = dw_hdmi_rockchip_mode_valid,
491 .mpll_cfg = rockchip_mpll_cfg,
492 .cur_ctr = rockchip_cur_ctr,
493 .phy_config = rockchip_phy_config,
494 .phy_data = &rk3328_chip_data,
495 .phy_ops = &rk3328_hdmi_phy_ops,
496 .phy_name = "inno_dw_hdmi_phy2",
497 .phy_force_vendor = true,
498 .use_drm_infoframe = true,
501 static struct rockchip_hdmi_chip_data rk3399_chip_data = {
502 .lcdsel_grf_reg = RK3399_GRF_SOC_CON20,
503 .lcdsel_big = HIWORD_UPDATE(0, RK3399_HDMI_LCDC_SEL),
504 .lcdsel_lit = HIWORD_UPDATE(RK3399_HDMI_LCDC_SEL, RK3399_HDMI_LCDC_SEL),
507 static const struct dw_hdmi_plat_data rk3399_hdmi_drv_data = {
508 .mode_valid = dw_hdmi_rockchip_mode_valid,
509 .mpll_cfg = rockchip_mpll_cfg,
510 .cur_ctr = rockchip_cur_ctr,
511 .phy_config = rockchip_phy_config,
512 .phy_data = &rk3399_chip_data,
513 .use_drm_infoframe = true,
516 static struct rockchip_hdmi_chip_data rk3568_chip_data = {
517 .lcdsel_grf_reg = -1,
520 static const struct dw_hdmi_plat_data rk3568_hdmi_drv_data = {
521 .mode_valid = dw_hdmi_rockchip_mode_valid,
522 .mpll_cfg = rockchip_mpll_cfg,
523 .cur_ctr = rockchip_cur_ctr,
524 .phy_config = rockchip_phy_config,
525 .phy_data = &rk3568_chip_data,
526 .use_drm_infoframe = true,
529 static const struct of_device_id dw_hdmi_rockchip_dt_ids[] = {
530 { .compatible = "rockchip,rk3228-dw-hdmi",
531 .data = &rk3228_hdmi_drv_data
533 { .compatible = "rockchip,rk3288-dw-hdmi",
534 .data = &rk3288_hdmi_drv_data
536 { .compatible = "rockchip,rk3328-dw-hdmi",
537 .data = &rk3328_hdmi_drv_data
539 { .compatible = "rockchip,rk3399-dw-hdmi",
540 .data = &rk3399_hdmi_drv_data
542 { .compatible = "rockchip,rk3568-dw-hdmi",
543 .data = &rk3568_hdmi_drv_data
547 MODULE_DEVICE_TABLE(of, dw_hdmi_rockchip_dt_ids);
549 static int dw_hdmi_rockchip_bind(struct device *dev, struct device *master,
552 struct platform_device *pdev = to_platform_device(dev);
553 struct dw_hdmi_plat_data *plat_data;
554 const struct of_device_id *match;
555 struct drm_device *drm = data;
556 struct drm_encoder *encoder;
557 struct rockchip_hdmi *hdmi;
560 if (!pdev->dev.of_node)
563 hdmi = devm_kzalloc(&pdev->dev, sizeof(*hdmi), GFP_KERNEL);
567 match = of_match_node(dw_hdmi_rockchip_dt_ids, pdev->dev.of_node);
568 plat_data = devm_kmemdup(&pdev->dev, match->data,
569 sizeof(*plat_data), GFP_KERNEL);
573 hdmi->dev = &pdev->dev;
574 hdmi->plat_data = plat_data;
575 hdmi->chip_data = plat_data->phy_data;
576 plat_data->phy_data = hdmi;
577 plat_data->priv_data = hdmi;
578 encoder = &hdmi->encoder.encoder;
580 encoder->possible_crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
581 rockchip_drm_encoder_set_crtc_endpoint_id(&hdmi->encoder,
585 * If we failed to find the CRTC(s) which this encoder is
586 * supposed to be connected to, it's because the CRTC has
587 * not been registered yet. Defer probing, and hope that
588 * the required CRTC is added later.
590 if (encoder->possible_crtcs == 0)
591 return -EPROBE_DEFER;
593 ret = rockchip_hdmi_parse_dt(hdmi);
595 if (ret != -EPROBE_DEFER)
596 DRM_DEV_ERROR(hdmi->dev, "Unable to parse OF data\n");
600 hdmi->phy = devm_phy_optional_get(dev, "hdmi");
601 if (IS_ERR(hdmi->phy)) {
602 ret = PTR_ERR(hdmi->phy);
603 if (ret != -EPROBE_DEFER)
604 DRM_DEV_ERROR(hdmi->dev, "failed to get phy\n");
608 ret = regulator_enable(hdmi->avdd_0v9);
610 DRM_DEV_ERROR(hdmi->dev, "failed to enable avdd0v9: %d\n", ret);
614 ret = regulator_enable(hdmi->avdd_1v8);
616 DRM_DEV_ERROR(hdmi->dev, "failed to enable avdd1v8: %d\n", ret);
620 ret = clk_prepare_enable(hdmi->ref_clk);
622 DRM_DEV_ERROR(hdmi->dev, "Failed to enable HDMI reference clock: %d\n",
627 if (hdmi->chip_data == &rk3568_chip_data) {
628 regmap_write(hdmi->regmap, RK3568_GRF_VO_CON1,
629 HIWORD_UPDATE(RK3568_HDMI_SDAIN_MSK |
630 RK3568_HDMI_SCLIN_MSK,
631 RK3568_HDMI_SDAIN_MSK |
632 RK3568_HDMI_SCLIN_MSK));
635 drm_encoder_helper_add(encoder, &dw_hdmi_rockchip_encoder_helper_funcs);
636 drm_simple_encoder_init(drm, encoder, DRM_MODE_ENCODER_TMDS);
638 platform_set_drvdata(pdev, hdmi);
640 hdmi->hdmi = dw_hdmi_bind(pdev, encoder, plat_data);
643 * If dw_hdmi_bind() fails we'll never call dw_hdmi_unbind(),
644 * which would have called the encoder cleanup. Do it manually.
646 if (IS_ERR(hdmi->hdmi)) {
647 ret = PTR_ERR(hdmi->hdmi);
654 drm_encoder_cleanup(encoder);
655 clk_disable_unprepare(hdmi->ref_clk);
657 regulator_disable(hdmi->avdd_1v8);
659 regulator_disable(hdmi->avdd_0v9);
664 static void dw_hdmi_rockchip_unbind(struct device *dev, struct device *master,
667 struct rockchip_hdmi *hdmi = dev_get_drvdata(dev);
669 dw_hdmi_unbind(hdmi->hdmi);
670 drm_encoder_cleanup(&hdmi->encoder.encoder);
671 clk_disable_unprepare(hdmi->ref_clk);
673 regulator_disable(hdmi->avdd_1v8);
674 regulator_disable(hdmi->avdd_0v9);
677 static const struct component_ops dw_hdmi_rockchip_ops = {
678 .bind = dw_hdmi_rockchip_bind,
679 .unbind = dw_hdmi_rockchip_unbind,
682 static int dw_hdmi_rockchip_probe(struct platform_device *pdev)
684 return component_add(&pdev->dev, &dw_hdmi_rockchip_ops);
687 static int dw_hdmi_rockchip_remove(struct platform_device *pdev)
689 component_del(&pdev->dev, &dw_hdmi_rockchip_ops);
694 static int __maybe_unused dw_hdmi_rockchip_resume(struct device *dev)
696 struct rockchip_hdmi *hdmi = dev_get_drvdata(dev);
698 dw_hdmi_resume(hdmi->hdmi);
703 static const struct dev_pm_ops dw_hdmi_rockchip_pm = {
704 SET_SYSTEM_SLEEP_PM_OPS(NULL, dw_hdmi_rockchip_resume)
707 struct platform_driver dw_hdmi_rockchip_pltfm_driver = {
708 .probe = dw_hdmi_rockchip_probe,
709 .remove = dw_hdmi_rockchip_remove,
711 .name = "dwhdmi-rockchip",
712 .pm = &dw_hdmi_rockchip_pm,
713 .of_match_table = dw_hdmi_rockchip_dt_ids,