[v7 PATCH 6/6] drm/rockchip: cdn-dp: add cdn DP support for rk3399

Guenter Roeck groeck at google.com
Wed Jul 27 15:24:51 PDT 2016


On Wed, Jul 27, 2016 at 6:07 AM, Chris Zhong <zyw at rock-chips.com> wrote:
> Add support for cdn DP controller which is embedded in the rk3399
> SoCs. The DP is compliant with DisplayPort Specification,
> Version 1.3, This IP is compatible with the rockchip type-c PHY IP.
> There is a uCPU in DP controller, it need a firmware to work,
> please put the firmware file to /lib/firmware/rockchip/dptx.bin. The
> uCPU in charge of aux communication and link training, the host use
> mailbox to communicate with the ucpu.
> The dclk pin_pol of vop must not be invert for DP.
>
> Signed-off-by: Chris Zhong <zyw at rock-chips.com>
> Reviewed-by: Sean Paul <seanpaul at chromium.org>
> Acked-by: Mark Yao <mark.yao at rock-chips.com>
>
> ---
>
> Changes in v7:
> - support firmware standby when no dptx connection
> - optimization the calculation of tu size and valid symbol
>
> Changes in v6:
> - add a port struct
> - select SND_SOC_HDMI_CODEC
> - force reset the phy when hpd detected
>
> Changes in v5:
> - alphabetical order
> - do not use long, use u32 or u64
> - return MODE_CLOCK_HIGH when requested > actual
> - Optimized Coding Style
> - add a formula to get better tu size and symbol value.
> - modify according to Sean Paul's comments
> - fixed the fw_wait always 0
>
> Changes in v4:
> - use phy framework to control DP phy
> - support 2 phys
>
> Changes in v3:
> - use EXTCON_DISP_DP and EXTCON_DISP_DP_ALT cable to get dp port state.
> - reset spdif before config it
> - modify the firmware clk to 100Mhz
> - retry load firmware if fw file is requested too early
>
> Changes in v2:
> - Alphabetic order
> - remove excess error message
> - use define clk_rate
> - check all return value
> - remove dev_set_name(dp->dev, "cdn-dp");
> - use schedule_delayed_work
> - remove never-called functions
> - remove some unnecessary ()
>
> Changes in v1:
> - use extcon API
> - use hdmi-codec for the DP Asoc
> - do not initialize the "ret"
> - printk a err log when drm_of_encoder_active_endpoint_id
> - modify the dclk pin_pol to a single line
>
>  drivers/gpu/drm/rockchip/Kconfig            |  10 +
>  drivers/gpu/drm/rockchip/Makefile           |   1 +
>  drivers/gpu/drm/rockchip/cdn-dp-core.c      | 877 ++++++++++++++++++++++++++
>  drivers/gpu/drm/rockchip/cdn-dp-core.h      | 103 ++++
>  drivers/gpu/drm/rockchip/cdn-dp-reg.c       | 916 ++++++++++++++++++++++++++++
>  drivers/gpu/drm/rockchip/cdn-dp-reg.h       | 482 +++++++++++++++
>  drivers/gpu/drm/rockchip/rockchip_drm_vop.c |  13 +-
>  drivers/gpu/drm/rockchip/rockchip_drm_vop.h |   9 +
>  drivers/gpu/drm/rockchip/rockchip_vop_reg.c |   2 +
>  9 files changed, 2410 insertions(+), 3 deletions(-)
>  create mode 100644 drivers/gpu/drm/rockchip/cdn-dp-core.c
>  create mode 100644 drivers/gpu/drm/rockchip/cdn-dp-core.h
>  create mode 100644 drivers/gpu/drm/rockchip/cdn-dp-reg.c
>  create mode 100644 drivers/gpu/drm/rockchip/cdn-dp-reg.h
>
> diff --git a/drivers/gpu/drm/rockchip/Kconfig b/drivers/gpu/drm/rockchip/Kconfig
> index d30bdc3..20aaafe 100644
> --- a/drivers/gpu/drm/rockchip/Kconfig
> +++ b/drivers/gpu/drm/rockchip/Kconfig
> @@ -25,6 +25,16 @@ config ROCKCHIP_ANALOGIX_DP
>           for the Analogix Core DP driver. If you want to enable DP
>           on RK3288 based SoC, you should selet this option.
>
> +config ROCKCHIP_CDN_DP
> +        tristate "Rockchip cdn DP"
> +        depends on DRM_ROCKCHIP
> +       select SND_SOC_HDMI_CODEC if SND_SOC
> +        help
> +         This selects support for Rockchip SoC specific extensions
> +         for the cdn DP driver. If you want to enable Dp on
> +         RK3399 based SoC, you should select this
> +         option.
> +
>  config ROCKCHIP_DW_HDMI
>          tristate "Rockchip specific extensions for Synopsys DW HDMI"
>          depends on DRM_ROCKCHIP
> diff --git a/drivers/gpu/drm/rockchip/Makefile b/drivers/gpu/drm/rockchip/Makefile
> index 05d0713..abdecd5 100644
> --- a/drivers/gpu/drm/rockchip/Makefile
> +++ b/drivers/gpu/drm/rockchip/Makefile
> @@ -7,6 +7,7 @@ rockchipdrm-y := rockchip_drm_drv.o rockchip_drm_fb.o \
>  rockchipdrm-$(CONFIG_DRM_FBDEV_EMULATION) += rockchip_drm_fbdev.o
>
>  obj-$(CONFIG_ROCKCHIP_ANALOGIX_DP) += analogix_dp-rockchip.o
> +obj-$(CONFIG_ROCKCHIP_CDN_DP) += cdn-dp-core.o cdn-dp-reg.o
>  obj-$(CONFIG_ROCKCHIP_DW_HDMI) += dw_hdmi-rockchip.o
>  obj-$(CONFIG_ROCKCHIP_DW_MIPI_DSI) += dw-mipi-dsi.o
>  obj-$(CONFIG_ROCKCHIP_INNO_HDMI) += inno_hdmi.o
> diff --git a/drivers/gpu/drm/rockchip/cdn-dp-core.c b/drivers/gpu/drm/rockchip/cdn-dp-core.c
> new file mode 100644
> index 0000000..31d146c
> --- /dev/null
> +++ b/drivers/gpu/drm/rockchip/cdn-dp-core.c
> @@ -0,0 +1,877 @@
> +/*
> + * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
> + * Author: Chris Zhong <zyw at rock-chips.com>
> + *
> + * This software is licensed under the terms of the GNU General Public
> + * License version 2, as published by the Free Software Foundation, and
> + * may be copied, distributed, and modified under those terms.
> + *
> + * This program is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> + * GNU General Public License for more details.
> + */
> +
> +#include <drm/drmP.h>
> +#include <drm/drm_atomic_helper.h>
> +#include <drm/drm_crtc_helper.h>
> +#include <drm/drm_dp_helper.h>
> +#include <drm/drm_edid.h>
> +#include <drm/drm_of.h>
> +
> +#include <linux/clk.h>
> +#include <linux/component.h>
> +#include <linux/extcon.h>
> +#include <linux/firmware.h>
> +#include <linux/regmap.h>
> +#include <linux/reset.h>
> +#include <linux/mfd/syscon.h>
> +#include <linux/phy/phy.h>
> +

Any chance for alphabetic order ?

> +#include <sound/hdmi-codec.h>
> +
> +#include "cdn-dp-core.h"
> +#include "cdn-dp-reg.h"
> +#include "rockchip_drm_vop.h"
> +
> +#define connector_to_dp(c) \
> +               container_of(c, struct cdn_dp_device, connector)
> +
> +#define encoder_to_dp(c) \
> +               container_of(c, struct cdn_dp_device, encoder)
> +
> +/* dp grf register offset */
> +#define DP_VOP_SEL             0x6224
> +#define DP_SEL_VOP_LIT         BIT(12)
> +#define MAX_FW_WAIT_SECS       64
> +#define CDN_DP_FIRMWARE                "rockchip/dptx.bin"
> +
> +struct cdn_dp_data {
> +       u8 max_phy;
> +};
> +
> +struct cdn_dp_data rk3399_cdn_dp = {
> +       .max_phy = 2,
> +};
> +
> +static const struct of_device_id cdn_dp_dt_ids[] = {
> +       { .compatible = "rockchip,rk3399-cdn-dp",
> +               .data = (void *)&rk3399_cdn_dp },
> +       {}
> +};
> +
> +MODULE_DEVICE_TABLE(of, cdn_dp_dt_ids);
> +
> +static int cdn_dp_clk_enable(struct cdn_dp_device *dp)
> +{
> +       int ret;
> +       u32 rate;
> +
> +       ret = clk_prepare_enable(dp->pclk);
> +       if (ret < 0) {
> +               dev_err(dp->dev, "cannot enable dp pclk %d\n", ret);
> +               goto err_pclk;
> +       }
> +
> +       ret = clk_prepare_enable(dp->core_clk);
> +       if (ret < 0) {
> +               dev_err(dp->dev, "cannot enable core_clk %d\n", ret);
> +               goto err_core_clk;
> +       }
> +
> +       rate = clk_get_rate(dp->core_clk);
> +       if (rate < 0) {
> +               dev_err(dp->dev, "get clk rate failed: %d\n", rate);
> +               goto err_set_rate;
> +       }
> +
> +       cdn_dp_set_fw_clk(dp, rate);
> +
> +       return 0;
> +
> +err_set_rate:
> +       clk_disable_unprepare(dp->core_clk);
> +err_core_clk:
> +       clk_disable_unprepare(dp->pclk);
> +err_pclk:
> +       return ret;
> +}
> +
> +static enum drm_connector_status
> +cdn_dp_connector_detect(struct drm_connector *connector, bool force)
> +{
> +       struct cdn_dp_device *dp = connector_to_dp(connector);
> +
> +       return dp->hpd_status;
> +}
> +
> +static void cdn_dp_connector_destroy(struct drm_connector *connector)
> +{
> +       drm_connector_unregister(connector);
> +       drm_connector_cleanup(connector);
> +}
> +
> +static struct drm_connector_funcs cdn_dp_atomic_connector_funcs = {
> +       .dpms = drm_atomic_helper_connector_dpms,
> +       .detect = cdn_dp_connector_detect,
> +       .destroy = cdn_dp_connector_destroy,
> +       .fill_modes = drm_helper_probe_single_connector_modes,
> +       .reset = drm_atomic_helper_connector_reset,
> +       .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
> +       .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
> +};
> +
> +static int cdn_dp_connector_get_modes(struct drm_connector *connector)
> +{
> +       struct cdn_dp_device *dp = connector_to_dp(connector);
> +       struct edid *edid;
> +       int ret = 0;
> +
> +       edid = drm_do_get_edid(connector, cdn_dp_get_edid_block, dp);
> +       if (edid) {
> +               dev_dbg(dp->dev, "got edid: width[%d] x height[%d]\n",
> +                       edid->width_cm, edid->height_cm);
> +
> +               dp->sink_has_audio = drm_detect_monitor_audio(edid);
> +               ret = drm_add_edid_modes(connector, edid);
> +               if (ret) {
> +                       drm_mode_connector_update_edid_property(connector,
> +                                                               edid);
> +                       drm_edid_to_eld(connector, edid);
> +               }
> +               kfree(edid);
> +       } else {
> +               dev_warn(dp->dev, "failed to get edid\n");

Does this indicate a problem, and does the message add any value to
the user ? I am seeing it a lot, but I never know if it is something
to be concerned about or not.

If the message does not add value and/or indicate a real problem,
maybe it should be removed ?

> +       }
> +
> +       return ret;
> +}
> +
> +static struct drm_encoder *
> +       cdn_dp_connector_best_encoder(struct drm_connector *connector)
> +{
> +       struct cdn_dp_device *dp = connector_to_dp(connector);
> +
> +       return &dp->encoder;
> +}
> +
> +static int cdn_dp_connector_mode_valid(struct drm_connector *connector,
> +                                      struct drm_display_mode *mode)
> +{
> +       struct cdn_dp_device *dp = connector_to_dp(connector);
> +       struct drm_display_info *display_info = &dp->connector.display_info;
> +       u32 requested = mode->clock * display_info->bpc * 3 / 1000;
> +       u32 sink_max, source_max, rate;
> +       u8 lanes, i;
> +       u32 actual;
> +
> +       /* find the running port */
> +       for (i = 0; i < dp->ports; i++) {
> +               if (dp->port[i]->phy_status == 1) {

phy_status is defined as bool, so comparisons against 1 (or 0) are unnecessary.
Also, you should use true / false for assignments to it.

> +                       source_max = dp->port[i]->cap_lanes;
> +                       break;
> +               }
> +       }

If this code doesn't find a valid port, source_max will be undefined.
Maybe initialize source_max with 0 ?

> +
> +       sink_max = drm_dp_max_lane_count(dp->dpcd);
> +       lanes = min(source_max, sink_max);
> +
> +       source_max = drm_dp_bw_code_to_link_rate(CDN_DP_MAX_LINK_RATE);
> +       sink_max = drm_dp_max_link_rate(dp->dpcd);
> +       rate = min(source_max, sink_max);
> +
> +       actual = rate * lanes / 100;
> +
> +       /* efficiency is about 0.8 */
> +       actual = actual * 8 / 10;
> +
> +       if (requested > actual) {
> +               dev_dbg(dp->dev, "requested=%d, actual=%d, clock=%d\n",
> +                       requested, actual, mode->clock);
> +               return MODE_CLOCK_HIGH;
> +       }
> +
> +       return MODE_OK;
> +}
> +
> +static struct drm_connector_helper_funcs cdn_dp_connector_helper_funcs = {
> +       .get_modes = cdn_dp_connector_get_modes,
> +       .best_encoder = cdn_dp_connector_best_encoder,
> +       .mode_valid = cdn_dp_connector_mode_valid,
> +};
> +
> +static void cdn_dp_commit(struct drm_encoder *encoder)
> +{
> +       struct cdn_dp_device *dp = encoder_to_dp(encoder);
> +       int ret;
> +
> +       ret = cdn_dp_training_start(dp);
> +       if (ret) {
> +               dev_err(dp->dev, "link training failed: %d\n", ret);

An error which is then ignored ? Does this make sense ?

> +               return;
> +       }
> +
> +       ret = cdn_dp_get_training_status(dp);
> +       if (ret) {
> +               dev_err(dp->dev, "get link training status failed: %d\n", ret);
> +               return;
> +       }
> +
> +       dev_info(dp->dev, "rate:0x%x, lanes:%d\n",
> +                dp->link.rate, dp->link.num_lanes);

dev_dbg for the final version, probably.

> +
> +       if (cdn_dp_set_video_status(dp, CONTROL_VIDEO_IDLE))
> +               return;
> +
> +       if (cdn_dp_config_video(dp)) {
> +               dev_err(dp->dev, "unable to config video\n");
> +               return;
> +       }
> +
> +       if (cdn_dp_set_video_status(dp, CONTROL_VIDEO_VALID))
> +               return;
> +
> +       dp->dpms_mode = DRM_MODE_DPMS_ON;
> +}
> +
> +static void cdn_dp_encoder_mode_set(struct drm_encoder *encoder,
> +                                   struct drm_display_mode *mode,
> +                                   struct drm_display_mode *adjusted)
> +{
> +       struct cdn_dp_device *dp = encoder_to_dp(encoder);
> +       struct drm_display_info *display_info = &dp->connector.display_info;
> +       struct rockchip_crtc_state *state;
> +       struct video_info *video = &dp->video_info;
> +       int ret, val;
> +
> +       switch (display_info->bpc) {
> +       case 16:
> +       case 12:
> +       case 10:
> +               video->color_depth = 10;
> +               break;
> +       case 6:
> +               video->color_depth = 6;
> +               break;
> +       default:
> +               video->color_depth = 8;
> +               break;
> +       }
> +
> +       video->color_fmt = PXL_RGB;
> +
> +       video->v_sync_polarity = !!(mode->flags & DRM_MODE_FLAG_NVSYNC);
> +       video->h_sync_polarity = !!(mode->flags & DRM_MODE_FLAG_NHSYNC);
> +
> +       ret = drm_of_encoder_active_endpoint_id(dp->dev->of_node, encoder);
> +       if (ret < 0) {
> +               dev_err(dp->dev, "Could not get vop id, %d", ret);
> +               return;
> +       }
> +
> +       dev_dbg(dp->dev, "vop %s output to cdn-dp\n", (ret) ? "LIT" : "BIG");
> +       state = to_rockchip_crtc_state(encoder->crtc->state);
> +       if (ret) {
> +               val = DP_SEL_VOP_LIT | (DP_SEL_VOP_LIT << 16);
> +               state->output_mode = ROCKCHIP_OUT_MODE_P888;
> +       } else {
> +               val = DP_SEL_VOP_LIT << 16;
> +               state->output_mode = ROCKCHIP_OUT_MODE_AAAA;
> +       }
> +       ret = regmap_write(dp->grf, DP_VOP_SEL, val);
> +       if (ret != 0)
> +               dev_err(dp->dev, "Could not write to GRF: %d\n", ret);
> +
> +       memcpy(&dp->mode, adjusted, sizeof(*mode));
> +}
> +
> +static void cdn_dp_encoder_enable(struct drm_encoder *encoder)
> +{
> +       struct cdn_dp_device *dp = encoder_to_dp(encoder);
> +
> +       if (dp->dpms_mode != DRM_MODE_DPMS_ON)
> +               cdn_dp_commit(encoder);
> +}
> +
> +static void cdn_dp_encoder_disable(struct drm_encoder *encoder)
> +{
> +       struct cdn_dp_device *dp = encoder_to_dp(encoder);
> +
> +       if (dp->dpms_mode != DRM_MODE_DPMS_OFF) {
> +               cdn_dp_set_video_status(dp, CONTROL_VIDEO_IDLE);
> +               dp->dpms_mode = DRM_MODE_DPMS_OFF;
> +       }
> +}
> +
> +static int
> +cdn_dp_encoder_atomic_check(struct drm_encoder *encoder,
> +                           struct drm_crtc_state *crtc_state,
> +                           struct drm_connector_state *conn_state)
> +{
> +       struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
> +
> +       s->output_mode = ROCKCHIP_OUT_MODE_AAAA;
> +       s->output_type = DRM_MODE_CONNECTOR_DisplayPort;
> +
> +       return 0;
> +}
> +
> +static struct drm_encoder_helper_funcs cdn_dp_encoder_helper_funcs = {
> +       .mode_set = cdn_dp_encoder_mode_set,
> +       .enable = cdn_dp_encoder_enable,
> +       .disable = cdn_dp_encoder_disable,
> +       .atomic_check = cdn_dp_encoder_atomic_check,
> +};
> +
> +static struct drm_encoder_funcs cdn_dp_encoder_funcs = {
> +       .destroy = drm_encoder_cleanup,
> +};
> +
> +static int cdn_dp_firmware_init(struct cdn_dp_device *dp)
> +{
> +       int ret;
> +       const u32 *iram_data, *dram_data;
> +       const struct firmware *fw = dp->fw;
> +       const struct cdn_firmware_header *hdr;
> +
> +       hdr = (struct cdn_firmware_header *)fw->data;
> +       if (fw->size != le32_to_cpu(hdr->size_bytes)) {
> +               dev_err(dp->dev, "firmware is invalid\n");
> +               return -EINVAL;
> +       }
> +
> +       iram_data = (const u32 *)(fw->data + hdr->header_size);
> +       dram_data = (const u32 *)(fw->data + hdr->header_size + hdr->iram_size);
> +
> +       ret = cdn_dp_load_firmware(dp, iram_data, hdr->iram_size,
> +                                  dram_data, hdr->dram_size);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_active(dp, true);
> +       if (ret) {
> +               dev_err(dp->dev, "active ucpu failed: %d\n", ret);
> +               return ret;
> +       }
> +
> +       dp->fw_loaded = 1;
> +
> +       return cdn_dp_event_config(dp);
> +}
> +
> +static int cdn_dp_init(struct cdn_dp_device *dp)
> +{
> +       struct device *dev = dp->dev;
> +       struct device_node *np = dev->of_node;
> +       struct platform_device *pdev = to_platform_device(dev);
> +       struct resource *res;
> +       int ret;
> +
> +       dp->grf = syscon_regmap_lookup_by_phandle(np, "rockchip,grf");
> +       if (IS_ERR(dp->grf)) {
> +               dev_err(dev, "cdn-dp needs rockchip,grf property\n");
> +               return PTR_ERR(dp->grf);
> +       }
> +
> +       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> +       dp->regs = devm_ioremap_resource(dev, res);
> +       if (IS_ERR(dp->regs)) {
> +               dev_err(dev, "ioremap reg failed\n");
> +               return PTR_ERR(dp->regs);
> +       }
> +
> +       dp->core_clk = devm_clk_get(dev, "core-clk");
> +       if (IS_ERR(dp->core_clk)) {
> +               dev_err(dev, "cannot get core_clk_dp\n");
> +               return PTR_ERR(dp->core_clk);
> +       }
> +
> +       dp->pclk = devm_clk_get(dev, "pclk");
> +       if (IS_ERR(dp->pclk)) {
> +               dev_err(dev, "cannot get pclk\n");
> +               return PTR_ERR(dp->pclk);
> +       }
> +
> +       dp->spdif_clk = devm_clk_get(dev, "spdif");
> +       if (IS_ERR(dp->spdif_clk)) {
> +               dev_err(dev, "cannot get spdif_clk\n");
> +               return PTR_ERR(dp->spdif_clk);
> +       }
> +
> +       dp->spdif_rst = devm_reset_control_get(dev, "spdif");
> +       if (IS_ERR(dp->spdif_rst)) {
> +               dev_err(dev, "no spdif reset control found\n");
> +               return PTR_ERR(dp->spdif_rst);
> +       }
> +
> +       dp->dpms_mode = DRM_MODE_DPMS_OFF;
> +
> +       ret = cdn_dp_clk_enable(dp);
> +       if (ret < 0)
> +               return ret;
> +
> +       cdn_dp_clock_reset(dp);
> +
> +       return 0;
> +}
> +
> +static int cdn_dp_audio_hw_params(struct device *dev,  void *data,
> +                                 struct hdmi_codec_daifmt *daifmt,
> +                                 struct hdmi_codec_params *params)
> +{
> +       struct cdn_dp_device *dp = dev_get_drvdata(dev);
> +       struct audio_info audio = {
> +               .sample_width = params->sample_width,
> +               .sample_rate = params->sample_rate,
> +               .channels = params->channels,
> +       };
> +       int ret;
> +
> +       if (!dp->encoder.crtc)
> +               return -ENODEV;
> +
> +       switch (daifmt->fmt) {
> +       case HDMI_I2S:
> +               audio.format = AFMT_I2S;
> +               break;
> +       case HDMI_SPDIF:
> +               audio.format = AFMT_SPDIF;
> +               break;
> +       default:
> +               dev_err(dev, "%s: Invalid format %d\n", __func__, daifmt->fmt);
> +               return -EINVAL;
> +       }
> +
> +       ret = cdn_dp_audio_config_set(dp, &audio);
> +       if (!ret)
> +               dp->audio_info = audio;
> +
> +       return ret;
> +}
> +
> +static void cdn_dp_audio_shutdown(struct device *dev, void *data)
> +{
> +       struct cdn_dp_device *dp = dev_get_drvdata(dev);
> +       int ret = cdn_dp_audio_stop(dp, &dp->audio_info);
> +
> +       if (!ret)
> +               dp->audio_info.format = AFMT_UNUSED;
> +}
> +
> +static int cdn_dp_audio_digital_mute(struct device *dev, void *data,
> +                                    bool enable)
> +{
> +       struct cdn_dp_device *dp = dev_get_drvdata(dev);
> +
> +       return cdn_dp_audio_mute(dp, enable);
> +}
> +
> +static int cdn_dp_audio_get_eld(struct device *dev, void *data,
> +                               uint8_t *buf, size_t len)

checkpatch suggests to use u8.

> +{
> +       struct cdn_dp_device *dp = dev_get_drvdata(dev);
> +       struct drm_mode_config *config = &dp->encoder.dev->mode_config;
> +       struct drm_connector *connector;
> +       int ret = -ENODEV;
> +
> +       mutex_lock(&config->mutex);
> +       list_for_each_entry(connector, &config->connector_list, head) {
> +               if (&dp->encoder == connector->encoder) {
> +                       memcpy(buf, connector->eld,
> +                              min(sizeof(connector->eld), len));
> +                       ret = 0;
> +               }
> +       }
> +       mutex_unlock(&config->mutex);
> +
> +       return ret;
> +}
> +
> +static const struct hdmi_codec_ops audio_codec_ops = {
> +       .hw_params = cdn_dp_audio_hw_params,
> +       .audio_shutdown = cdn_dp_audio_shutdown,
> +       .digital_mute = cdn_dp_audio_digital_mute,
> +       .get_eld = cdn_dp_audio_get_eld,
> +};
> +
> +static int cdn_dp_audio_codec_init(struct cdn_dp_device *dp,
> +                                  struct device *dev)
> +{
> +       struct hdmi_codec_pdata codec_data = {
> +               .i2s = 1,
> +               .spdif = 1,
> +               .ops = &audio_codec_ops,
> +               .max_i2s_channels = 8,
> +       };
> +
> +       dp->audio_pdev = platform_device_register_data(
> +                        dev, HDMI_CODEC_DRV_NAME, PLATFORM_DEVID_AUTO,
> +                        &codec_data, sizeof(codec_data));
> +
> +       return PTR_ERR_OR_ZERO(dp->audio_pdev);
> +}
> +
> +static int cdn_dp_get_cap_lanes(struct cdn_dp_device *dp,
> +                               struct extcon_dev *edev)
> +{
> +       bool dfp, dptx;
> +       u8 lanes;
> +
> +       dfp = extcon_get_cable_state_(edev, EXTCON_USB_HOST);
> +       dptx = extcon_get_cable_state_(edev, EXTCON_DISP_DP);
> +
> +       if (dfp && dptx)
> +               lanes = 2;
> +       else if (dptx)
> +               lanes = 4;
> +       else
> +               lanes = 0;
> +
> +       return lanes;
> +}
> +
> +static int cdn_dp_phy_power_ctrl(struct cdn_dp_device *dp,
> +                                struct cdn_dp_port *port, bool enable)
> +{
> +       struct phy *phy = port->phy;
> +       int ret;
> +       int count = 0;
> +
> +       while (phy->power_count > 0) {
> +               ret = phy_power_off(phy);
> +               if (ret)
> +                       return ret;
> +               count++;
> +       }
> +
> +       count = enable ? count + 1 : count - 1;
> +       while (count-- > 0) {
> +               ret = phy_power_on(phy);
> +               if (ret)
> +                       return ret;
> +       }
> +
> +       port->phy_status = enable;
> +       return 0;
> +}
> +
> +static int cdn_dp_pd_event(struct notifier_block *nb,
> +                          unsigned long event, void *priv)
> +{
> +       struct cdn_dp_port *port;
> +
> +       port = container_of(nb, struct cdn_dp_port, event_nb);
> +
> +       schedule_delayed_work(&port->event_wq, 0);
> +
> +       return 0;
> +}
> +
> +static void cdn_dp_pd_event_wq(struct work_struct *work)
> +{
> +       struct cdn_dp_port *port = container_of(work, struct cdn_dp_port,
> +                                               event_wq.work);
> +       struct cdn_dp_device *dp = port->dp;
> +       u8 new_cap_lanes;
> +       int ret;
> +       u8 i;
> +
> +       new_cap_lanes = cdn_dp_get_cap_lanes(dp, port->extcon);
> +
> +       if (new_cap_lanes == port->cap_lanes) {
> +               dev_warn(dp->dev, "lanes count does not change: %d\n",
> +                        new_cap_lanes);

Why dev_warn ? Or why a message in the first place ?

> +               return;
> +       }
> +
> +       if (!new_cap_lanes) {
> +               ret = cdn_dp_phy_power_ctrl(dp, port, 0);
> +               if (ret) {
> +                       dev_err(dp->dev, "phy power off failed: %d", ret);
> +                       return;
> +               }
> +               port->phy_status = 0;
> +               port->cap_lanes = new_cap_lanes;
> +               for (i = 0; i < dp->ports; i++) {
> +                       if (dp->port[i]->phy_status == 1)
> +                               return;
> +               }
> +
> +               dp->hpd_status = connector_status_disconnected;
> +               drm_helper_hpd_irq_event(dp->drm_dev);
> +               cdn_dp_active(dp, false);
> +               return;
> +       }
> +
> +       /* if other phy is running, do not touch the hpd_status, and return */
> +       for (i = 0; i < dp->ports; i++) {
> +               if (dp->port[i]->phy_status == 1) {
> +                       dev_warn(dp->dev, "busy, phy[%d] is running",
> +                                dp->port[i]->id);
> +                       return;
> +               }
> +       }
> +
> +       if (!dp->fw_loaded) {
> +               ret = request_firmware(&dp->fw, CDN_DP_FIRMWARE, dp->dev);
> +               if (ret == -ENOENT && dp->fw_wait <= MAX_FW_WAIT_SECS) {
> +                       unsigned long time = msecs_to_jiffies(dp->fw_wait * HZ);
> +
> +                       /*
> +                        * If can not find the file, retry to load the firmware
> +                        * in 1 second, if still failed after 1 minute, give up.

Comment (1 second) is no longer valid.

> +                        */
> +                       schedule_delayed_work(&port->event_wq, time);
> +                       dev_warn(dp->dev, "retry to request firmware in %dS\n",
> +                                dp->fw_wait);

I think this message should be dropped.

> +                       dp->fw_wait *= 2;
> +                       return;
> +               } else if (ret) {
> +                       dev_err(dp->dev, "failed to request firmware: %d\n",
> +                               ret);
> +                       return;
> +               }

Might move the return statement to this location.

> +       }
> +
> +       if (dp->fw_loaded)
> +               cdn_dp_active(dp, true);
> +
> +       ret = cdn_dp_phy_power_ctrl(dp, port, 1);
> +       if (ret) {
> +               if (!dp->fw_loaded)
> +                       release_firmware(dp->fw);
> +               dev_err(dp->dev, "phy power on failed: %d\n", ret);
> +               return;
> +       }
> +
> +       if (!dp->fw_loaded) {
> +               ret = cdn_dp_firmware_init(dp);
> +               release_firmware(dp->fw);
> +               if (ret) {
> +                       dev_err(dp->dev, "firmware init failed: %d", ret);
> +                       goto err_firmware;
> +               }
> +       }
> +
> +       /* read hpd status failed, or the hpd does not exist. */
> +       ret = cdn_dp_get_hpd_status(dp);
> +       if (ret <= 0) {
> +               dev_err(dp->dev, "get hpd failed: %d", ret);
> +               goto err_firmware;
> +       }
> +
> +       ret = cdn_dp_set_host_cap(dp, new_cap_lanes);
> +       if (ret) {
> +               dev_err(dp->dev, "set host capabilities failed: %d\n", ret);
> +               goto err_firmware;
> +       }
> +
> +       /*
> +        * Native read with retry for link status and receiver capability reads
> +        * for cases where the sink may still be asleep.
> +        *
> +        * Sinks are *supposed* to come up within 1ms from an off state, but
> +        * we're also supposed to retry 3 times per the spec.
> +        */
> +       for (i = 0; i < 3; i++) {
> +               ret = cdn_dp_dpcd_read(dp, 0x000, dp->dpcd,
> +                                      DP_RECEIVER_CAP_SIZE);
> +               if (!ret) {
> +                       dev_dbg(dp->dev, "get dpcd success!\n");
> +                       port->cap_lanes = new_cap_lanes;
> +                       dp->hpd_status = connector_status_connected;
> +                       drm_helper_hpd_irq_event(dp->drm_dev);
> +                       return;
> +               }
> +               usleep_range(1000, 1050);
> +       }
> +
> +       dev_err(dp->dev, "get dpcd failed: %d", ret);
> +
> +err_firmware:
> +       ret = cdn_dp_phy_power_ctrl(dp, port, 0);

The last parameter of cdn_dp_phy_power_ctrl() is bool, so this should
pass 'false' as parameter.
Same really everywhere else - instead of 0/1, use true / false for booleans.

> +       if (ret)
> +               dev_err(dp->dev, "phy power off failed: %d", ret);
> +       if (dp->fw_loaded)
> +               cdn_dp_active(dp, false);
> +}
> +
> +static int cdn_dp_bind(struct device *dev, struct device *master,
> +                      void *data)

Unnecessary line split.

> +{
> +       struct cdn_dp_device *dp = dev_get_drvdata(dev);
> +       struct drm_encoder *encoder;
> +       struct drm_connector *connector;
> +       struct cdn_dp_port *port;
> +       struct drm_device *drm_dev = data;
> +       int ret, i;
> +
> +       ret = cdn_dp_init(dp);
> +       if (ret < 0)
> +               return ret;
> +
> +       dp->drm_dev = drm_dev;
> +       dp->hpd_status = connector_status_disconnected;
> +       dp->fw_wait = 1;
> +
> +       encoder = &dp->encoder;
> +
> +       encoder->possible_crtcs = drm_of_find_possible_crtcs(drm_dev,
> +                                                            dev->of_node);
> +       DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs);
> +
> +       ret = drm_encoder_init(drm_dev, encoder, &cdn_dp_encoder_funcs,
> +                              DRM_MODE_ENCODER_TMDS, NULL);
> +       if (ret) {
> +               DRM_ERROR("failed to initialize encoder with drm\n");
> +               return ret;
> +       }
> +
> +       drm_encoder_helper_add(encoder, &cdn_dp_encoder_helper_funcs);
> +
> +       connector = &dp->connector;
> +       connector->polled = DRM_CONNECTOR_POLL_HPD;
> +       connector->dpms = DRM_MODE_DPMS_OFF;
> +
> +       ret = drm_connector_init(drm_dev, connector,
> +                                &cdn_dp_atomic_connector_funcs,
> +                                DRM_MODE_CONNECTOR_DisplayPort);
> +       if (ret) {
> +               DRM_ERROR("failed to initialize connector with drm\n");
> +               goto err_free_encoder;
> +       }
> +
> +       drm_connector_helper_add(connector, &cdn_dp_connector_helper_funcs);
> +
> +       ret = drm_mode_connector_attach_encoder(connector, encoder);
> +       if (ret) {
> +               DRM_ERROR("failed to attach connector and encoder\n");
> +               goto err_free_connector;
> +       }
> +
> +       cdn_dp_audio_codec_init(dp, dev);
> +
> +

Double empty line.


> +       for (i = 0; i < dp->ports; i++) {
> +               port = dp->port[i];
> +
> +               port->event_nb.notifier_call = cdn_dp_pd_event;
> +               INIT_DELAYED_WORK(&port->event_wq, cdn_dp_pd_event_wq);
> +               ret = extcon_register_notifier(port->extcon, EXTCON_DISP_DP,
> +                                              &port->event_nb);
> +               if (ret) {
> +                       dev_err(dev, "regitster EXTCON_DISP_DP notifier err\n");

register

> +                       return ret;
> +               }
> +
> +               if (extcon_get_cable_state_(port->extcon, EXTCON_DISP_DP))

extcon_get_state()


> +                       schedule_delayed_work(&port->event_wq, 0);
> +       }
> +
> +       return 0;
> +
> +err_free_connector:
> +       drm_connector_cleanup(connector);
> +err_free_encoder:
> +       drm_encoder_cleanup(encoder);
> +       return ret;
> +}
> +
> +static void cdn_dp_unbind(struct device *dev, struct device *master, void *data)
> +{
> +       struct cdn_dp_device *dp = dev_get_drvdata(dev);
> +       struct drm_encoder *encoder = &dp->encoder;
> +       struct drm_connector *connector = &dp->connector;
> +       struct cdn_dp_port *port;
> +       int i;
> +
> +       platform_device_unregister(dp->audio_pdev);
> +       cdn_dp_encoder_disable(encoder);
> +       encoder->funcs->destroy(encoder);
> +       connector->funcs->destroy(connector);
> +
> +       for (i = 0; i < dp->ports; i++) {
> +               port = dp->port[i];
> +               extcon_unregister_notifier(port->extcon, EXTCON_DISP_DP,
> +                                          &port->event_nb);
> +       }
> +}
> +
> +static const struct component_ops cdn_dp_component_ops = {
> +       .bind = cdn_dp_bind,
> +       .unbind = cdn_dp_unbind,
> +};
> +
> +static int cdn_dp_probe(struct platform_device *pdev)
> +{
> +       struct device *dev = &pdev->dev;
> +       const struct of_device_id *match;
> +       struct cdn_dp_data *dp_data;
> +       struct cdn_dp_port *port;
> +       struct cdn_dp_device *dp;
> +       struct extcon_dev *extcon;
> +       struct phy *phy;
> +       int i;
> +
> +       dp = devm_kzalloc(dev, sizeof(*dp), GFP_KERNEL);
> +       if (!dp)
> +               return -ENOMEM;
> +       dp->dev = dev;
> +
> +       match = of_match_node(cdn_dp_dt_ids, pdev->dev.of_node);
> +       dp_data = (struct cdn_dp_data *)match->data;

match->data is declared as void *, thus the typecast is not necessary,

> +
> +       for (i = 0; i < dp_data->max_phy; i++) {
> +               extcon = extcon_get_edev_by_phandle(dev, i);
> +               phy = devm_of_phy_get_by_index(dev, dev->of_node, i);
> +
> +               if (PTR_ERR(extcon) == -EPROBE_DEFER ||
> +                   PTR_ERR(phy) == -EPROBE_DEFER)
> +                       return -EPROBE_DEFER;
> +
> +               if (IS_ERR(extcon) || IS_ERR(phy))
> +                       continue;
> +
> +               port = devm_kzalloc(dev, sizeof(*port), GFP_KERNEL);
> +               if (!dp)
> +                       return -ENOMEM;
> +
> +               port->extcon = extcon;
> +               port->phy = phy;
> +               port->dp = dp;
> +               port->id = i;
> +               dp->port[dp->ports++] = port;
> +       }
> +
> +       if (!dp->ports) {
> +               dev_err(dev, "missing extcon or phy\n");
> +               return -EINVAL;
> +       }
> +
> +       dev_set_drvdata(dev, dp);
> +
> +       return component_add(dev, &cdn_dp_component_ops);
> +}
> +
> +static int cdn_dp_remove(struct platform_device *pdev)
> +{
> +       component_del(&pdev->dev, &cdn_dp_component_ops);
> +
> +       return 0;
> +}
> +
> +static struct platform_driver cdn_dp_driver = {
> +       .probe = cdn_dp_probe,
> +       .remove = cdn_dp_remove,
> +       .driver = {
> +                  .name = "cdn-dp",
> +                  .owner = THIS_MODULE,
> +                  .of_match_table = of_match_ptr(cdn_dp_dt_ids),
> +       },
> +};
> +
> +module_platform_driver(cdn_dp_driver);
> +
> +MODULE_AUTHOR("Chris Zhong <zyw at rock-chips.com>");
> +MODULE_DESCRIPTION("cdn DP Driver");
> +MODULE_LICENSE("GPL v2");
> diff --git a/drivers/gpu/drm/rockchip/cdn-dp-core.h b/drivers/gpu/drm/rockchip/cdn-dp-core.h
> new file mode 100644
> index 0000000..78424f9
> --- /dev/null
> +++ b/drivers/gpu/drm/rockchip/cdn-dp-core.h
> @@ -0,0 +1,103 @@
> +/*
> + * Copyright (C) 2016 Chris Zhong <zyw at rock-chips.com>
> + * Copyright (C) 2016 ROCKCHIP, Inc.
> + *
> + * This program is free software; you can redistribute it and/or modify
> + * it under the terms of the GNU General Public License as published by
> + * the Free Software Foundation; either version 2 of the License.
> + *
> + * This program is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> + * GNU General Public License for more details.
> + */
> +
> +#ifndef _CDN_DP_CORE_H
> +#define _CDN_DP_CORE_H
> +
> +#include <drm/drmP.h>
> +#include <drm/drm_crtc_helper.h>
> +#include <drm/drm_dp_helper.h>
> +#include <drm/drm_panel.h>
> +#include "rockchip_drm_drv.h"
> +
> +#define MAX_PHY                2
> +
> +enum audio_format {
> +       AFMT_I2S = 0,
> +       AFMT_SPDIF = 1,
> +       AFMT_UNUSED,
> +};
> +
> +struct audio_info {
> +       enum audio_format format;
> +       int sample_rate;
> +       int channels;
> +       int sample_width;
> +};
> +
> +enum vic_pxl_encoding_format {
> +       PXL_RGB = 0x1,
> +       YCBCR_4_4_4 = 0x2,
> +       YCBCR_4_2_2 = 0x4,
> +       YCBCR_4_2_0 = 0x8,
> +       Y_ONLY = 0x10,
> +};
> +
> +struct video_info {
> +       bool h_sync_polarity;
> +       bool v_sync_polarity;
> +       bool interlaced;
> +       int color_depth;
> +       enum vic_pxl_encoding_format color_fmt;
> +};
> +
> +struct cdn_firmware_header {
> +       u32 size_bytes; /* size of the entire header+image(s) in bytes */
> +       u32 header_size; /* size of just the header in bytes */
> +       u32 iram_size; /* size of iram */
> +       u32 dram_size; /* size of dram */
> +};
> +
> +struct cdn_dp_port {
> +       struct cdn_dp_device *dp;
> +       struct notifier_block event_nb;
> +       struct delayed_work event_wq;
> +       struct extcon_dev *extcon;
> +       struct phy *phy;
> +       u8 cap_lanes;
> +       bool phy_status;
> +       u8 id;
> +};
> +
> +struct cdn_dp_device {
> +       struct device *dev;
> +       struct drm_device *drm_dev;
> +       struct drm_connector connector;
> +       struct drm_encoder encoder;
> +       struct drm_display_mode mode;
> +       struct platform_device *audio_pdev;
> +
> +       const struct firmware *fw;      /* cdn dp firmware */
> +       unsigned int fw_version;        /* cdn fw version */
> +       u32 fw_wait;
> +       bool fw_loaded;
> +       bool fw_actived;
> +       void __iomem *regs;
> +       struct regmap *grf;
> +       struct clk *core_clk;
> +       struct clk *pclk;
> +       struct clk *spdif_clk;
> +       struct reset_control *spdif_rst;
> +       struct audio_info audio_info;
> +       struct video_info video_info;
> +       struct drm_dp_link link;
> +       struct cdn_dp_port *port[MAX_PHY];
> +       u8 ports;
> +
> +       u8 dpcd[DP_RECEIVER_CAP_SIZE];
> +       enum drm_connector_status hpd_status;
> +       int dpms_mode;
> +       bool sink_has_audio;
> +};
> +#endif  /* _CDN_DP_CORE_H */
> diff --git a/drivers/gpu/drm/rockchip/cdn-dp-reg.c b/drivers/gpu/drm/rockchip/cdn-dp-reg.c
> new file mode 100644
> index 0000000..4255dac
> --- /dev/null
> +++ b/drivers/gpu/drm/rockchip/cdn-dp-reg.c
> @@ -0,0 +1,916 @@
> +/*
> + * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
> + * Author: Chris Zhong <zyw at rock-chips.com>
> + *
> + * This software is licensed under the terms of the GNU General Public
> + * License version 2, as published by the Free Software Foundation, and
> + * may be copied, distributed, and modified under those terms.
> + *
> + * This program is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> + * GNU General Public License for more details.
> + */
> +
> +#include <linux/clk.h>
> +#include <linux/device.h>
> +#include <linux/delay.h>
> +#include <linux/io.h>
> +#include <linux/iopoll.h>
> +#include <linux/reset.h>
> +
> +#include "cdn-dp-core.h"
> +#include "cdn-dp-reg.h"
> +
> +#define CDN_DP_SPDIF_CLK               200000000
> +#define FW_ALIVE_TIMEOUT_US            1000000
> +#define MAILBOX_RETRY_US               1000
> +#define MAILBOX_TIMEOUT_US             5000000
> +#define LINK_TRAINING_RETRY_MS         20
> +#define LINK_TRAINING_TIMEOUT_MS       500
> +
> +void cdn_dp_set_fw_clk(struct cdn_dp_device *dp, u32 clk)
> +{
> +       writel(clk / 1000000, dp->regs + SW_CLK_H);
> +}
> +
> +void cdn_dp_clock_reset(struct cdn_dp_device *dp)
> +{
> +       u32 val;
> +
> +       val = DPTX_FRMR_DATA_CLK_RSTN_EN |
> +             DPTX_FRMR_DATA_CLK_EN |
> +             DPTX_PHY_DATA_RSTN_EN |
> +             DPTX_PHY_DATA_CLK_EN |
> +             DPTX_PHY_CHAR_RSTN_EN |
> +             DPTX_PHY_CHAR_CLK_EN |
> +             SOURCE_AUX_SYS_CLK_RSTN_EN |
> +             SOURCE_AUX_SYS_CLK_EN |
> +             DPTX_SYS_CLK_RSTN_EN |
> +             DPTX_SYS_CLK_EN |
> +             CFG_DPTX_VIF_CLK_RSTN_EN |
> +             CFG_DPTX_VIF_CLK_EN;
> +       writel(val, dp->regs + SOURCE_DPTX_CAR);
> +
> +       val = SOURCE_PHY_RSTN_EN | SOURCE_PHY_CLK_EN;
> +       writel(val, dp->regs + SOURCE_PHY_CAR);
> +
> +       val = SOURCE_PKT_SYS_RSTN_EN |
> +             SOURCE_PKT_SYS_CLK_EN |
> +             SOURCE_PKT_DATA_RSTN_EN |
> +             SOURCE_PKT_DATA_CLK_EN;
> +       writel(val, dp->regs + SOURCE_PKT_CAR);
> +
> +       val = SPDIF_CDR_CLK_RSTN_EN |
> +             SPDIF_CDR_CLK_EN |
> +             SOURCE_AIF_SYS_RSTN_EN |
> +             SOURCE_AIF_SYS_CLK_EN |
> +             SOURCE_AIF_CLK_RSTN_EN |
> +             SOURCE_AIF_CLK_EN;
> +       writel(val, dp->regs + SOURCE_AIF_CAR);
> +
> +       val = SOURCE_CIPHER_SYSTEM_CLK_RSTN_EN |
> +             SOURCE_CIPHER_SYS_CLK_EN |
> +             SOURCE_CIPHER_CHAR_CLK_RSTN_EN |
> +             SOURCE_CIPHER_CHAR_CLK_EN;
> +       writel(val, dp->regs + SOURCE_CIPHER_CAR);
> +
> +       val = SOURCE_CRYPTO_SYS_CLK_RSTN_EN |
> +             SOURCE_CRYPTO_SYS_CLK_EN;
> +       writel(val, dp->regs + SOURCE_CRYPTO_CAR);
> +
> +       val = ~(MAILBOX_INT_MASK_BIT | PIF_INT_MASK_BIT) & ALL_INT_MASK;
> +       writel(val, dp->regs + APB_INT_MASK);
> +}
> +
> +static int cdn_dp_mailbox_read(struct cdn_dp_device *dp, bool force)
> +{
> +       int val, ret;
> +
> +       if (!dp->fw_actived && !force)
> +               return -EPERM;
> +
> +       ret = readx_poll_timeout(readl, dp->regs + MAILBOX_EMPTY_ADDR,
> +                                val, !val, MAILBOX_RETRY_US,
> +                                MAILBOX_TIMEOUT_US);
> +       if (ret < 0) {
> +               dev_err(dp->dev, "failed to read mailbox, keep alive = %x\n",
> +                       readl(dp->regs + KEEP_ALIVE));
> +               return ret;
> +       }
> +
> +       return readl(dp->regs + MAILBOX0_RD_DATA) & 0xff;
> +}
> +
> +static int cdp_dp_mailbox_write(struct cdn_dp_device *dp, u8 val, bool force)
> +{
> +       int ret, full;
> +
> +       if (!dp->fw_actived && !force)
> +               return -EPERM;
> +
> +       ret = readx_poll_timeout(readl, dp->regs + MAILBOX_FULL_ADDR,
> +                                full, !full, MAILBOX_RETRY_US,
> +                                MAILBOX_TIMEOUT_US);
> +       if (ret < 0) {
> +               dev_err(dp->dev, "mailbox is full, keep alive = %x\n",
> +                       readl(dp->regs + KEEP_ALIVE));
> +               return ret;
> +       }
> +
> +       writel(val, dp->regs + MAILBOX0_WR_DATA);
> +
> +       return 0;
> +}
> +
> +static int cdn_dp_mailbox_validate_receive(struct cdn_dp_device *dp,
> +                                          u8 module_id, u8 opcode,
> +                                          u8 req_size)
> +{
> +       u32 mbox_size, i;
> +       u8 header[4];
> +       int ret;
> +
> +       /* read the header of the message */
> +       for (i = 0; i < 4; i++)  {
> +               ret = cdn_dp_mailbox_read(dp, 0);
> +               if (ret < 0)
> +                       return ret;
> +
> +               header[i] = ret;
> +       }
> +
> +       mbox_size = (header[2] << 8) | header[3];
> +
> +       if (opcode != header[0] || module_id != header[1] ||
> +           req_size != mbox_size) {
> +               dev_err(dp->dev, "mailbox validate failed");

Does this indicate a problem ? I am seeing it a lot with some Type-C
docks. What does it really mean ?

> +
> +               /*
> +                * If the message in mailbox is not what we want, we need to
> +                * clear the mailbox by read.
> +                */
> +               for (i = 0; i < mbox_size; i++)
> +                       if (cdn_dp_mailbox_read(dp, 0) < 0)
> +                               break;
> +
> +               return -EINVAL;
> +       }
> +
> +       return 0;
> +}
> +
> +static int cdn_dp_mailbox_read_receive(struct cdn_dp_device *dp,
> +                                      u8 *buff, u8 buff_size)
> +{
> +       u32 i;
> +       int ret;
> +
> +       for (i = 0; i < buff_size; i++) {
> +               ret = cdn_dp_mailbox_read(dp, 0);
> +               if (ret < 0)
> +                       return ret;
> +
> +               buff[i] = ret;
> +       }
> +
> +       return 0;
> +}
> +
> +static int cdn_dp_mailbox_send(struct cdn_dp_device *dp, u8 module_id,
> +                              u8 opcode, u16 size, u8 *message)
> +{
> +       u8 header[4];
> +       int ret, i;
> +
> +       header[0] = opcode;
> +       header[1] = module_id;
> +       header[2] = (size >> 8) & 0xff;
> +       header[3] = size & 0xff;
> +
> +       for (i = 0; i < 4; i++) {
> +               ret = cdp_dp_mailbox_write(dp, header[i], 0);
> +               if (ret)
> +                       return ret;
> +       }
> +
> +       for (i = 0; i < size; i++) {
> +               ret = cdp_dp_mailbox_write(dp, message[i], 0);
> +               if (ret) {
> +                       dev_err(dp->dev, "mailbox send failed: %d", ret);
> +                       return ret;
> +               }
> +       }
> +
> +       return 0;
> +}
> +
> +static int cdn_dp_reg_write(struct cdn_dp_device *dp, u16 addr, u32 val)
> +{
> +       u8 msg[6];
> +
> +       msg[0] = (addr >> 8) & 0xff;
> +       msg[1] = addr & 0xff;
> +       msg[2] = (val >> 24) & 0xff;
> +       msg[3] = (val >> 16) & 0xff;
> +       msg[4] = (val >> 8) & 0xff;
> +       msg[5] = val & 0xff;
> +       return cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_WRITE_REGISTER,
> +                                  sizeof(msg), msg);
> +}
> +
> +int cdn_dp_dpcd_read(struct cdn_dp_device *dp, u32 addr, u8 *data, u16 len)
> +{
> +       u8 msg[5], reg[5];
> +       int ret;
> +
> +       msg[0] = (len >> 8) & 0xff;
> +       msg[1] = len & 0xff;
> +       msg[2] = (addr >> 16) & 0xff;
> +       msg[3] = (addr >> 8) & 0xff;
> +       msg[4] = addr & 0xff;
> +       cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_READ_DPCD,
> +                           sizeof(msg), msg);
> +
> +       ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
> +                                             DPTX_READ_DPCD,
> +                                             sizeof(reg) + len);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_read_receive(dp, reg, sizeof(reg));
> +       if (ret)
> +               return ret;
> +
> +       return cdn_dp_mailbox_read_receive(dp, data, len);
> +}
> +
> +int cdn_dp_dpcd_write(struct cdn_dp_device *dp, u32 addr, u8 value)
> +{
> +       u8 msg[6], reg[5];
> +       int ret;
> +
> +       msg[0] = 0;
> +       msg[1] = 1;
> +       msg[2] = (addr >> 16) & 0xff;
> +       msg[3] = (addr >> 8) & 0xff;
> +       msg[4] = addr & 0xff;
> +       msg[5] = value;
> +       cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_WRITE_DPCD,
> +                           sizeof(msg), msg);
> +
> +       ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
> +                                             DPTX_WRITE_DPCD, sizeof(reg));
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_read_receive(dp, reg, sizeof(reg));
> +       if (ret)
> +               return ret;
> +
> +       if (addr != (reg[2] << 16 | reg[3] << 8 | reg[4])) {
> +               dev_err(dp->dev, "write dpcd failed\n");
> +               return -EINVAL;
> +       }
> +
> +       return 0;
> +}
> +
> +int cdn_dp_load_firmware(struct cdn_dp_device *dp, const u32 *i_mem,
> +                        u32 i_size, const u32 *d_mem, u32 d_size)
> +{
> +       int i, ret;
> +       u32 reg;
> +
> +       /* reset ucpu before load firmware*/
> +       writel(APB_IRAM_PATH | APB_DRAM_PATH | APB_XT_RESET,
> +              dp->regs + APB_CTRL);
> +
> +       for (i = 0; i < i_size; i += 4)
> +               writel(*i_mem++, dp->regs + ADDR_IMEM + i);
> +
> +       for (i = 0; i < d_size; i += 4)
> +               writel(*d_mem++, dp->regs + ADDR_DMEM + i);
> +
> +       /* un-reset ucpu */
> +       writel(0, dp->regs + APB_CTRL);
> +
> +       /* check the keep alive register to make sure fw working */
> +       ret = readx_poll_timeout(readl, dp->regs + KEEP_ALIVE,
> +                                reg, reg, 2000, FW_ALIVE_TIMEOUT_US);
> +       if (ret < 0) {
> +               dev_err(dp->dev, "failed to loaded the FW reg = %x\n", reg);
> +               return -EINVAL;
> +       }
> +
> +       reg = readl(dp->regs + VER_L) & 0xff;
> +       dp->fw_version = reg;
> +       reg = readl(dp->regs + VER_H) & 0xff;
> +       dp->fw_version |= reg << 8;
> +       reg = readl(dp->regs + VER_LIB_L_ADDR) & 0xff;
> +       dp->fw_version |= reg << 16;
> +       reg = readl(dp->regs + VER_LIB_H_ADDR) & 0xff;
> +       dp->fw_version |= reg << 24;
> +
> +       dev_dbg(dp->dev, "firmware version: %x\n", dp->fw_version);
> +
> +       return 0;
> +}
> +
> +int cdn_dp_active(struct cdn_dp_device *dp, bool enable)
> +{
> +       u8 msg[5];
> +       int ret, i;
> +
> +       msg[0] = GENERAL_MAIN_CONTROL;
> +       msg[1] = MB_MODULE_ID_GENERAL;
> +       msg[2] = 0;
> +       msg[3] = 1;
> +       msg[4] = enable ? FW_ACTIVE : FW_STANDBY;
> +
> +       for (i = 0; i < sizeof(msg); i++) {
> +               ret = cdp_dp_mailbox_write(dp, msg[i], 1);
> +               if (ret)
> +                       return ret;
> +       }
> +
> +       /* read the firmware state */
> +       for (i = 0; i < sizeof(msg); i++)  {
> +               ret = cdn_dp_mailbox_read(dp, 1);
> +               if (ret < 0)
> +                       return ret;
> +
> +               msg[i] = ret;
> +       }
> +
> +       dp->fw_actived = (msg[4] == FW_ACTIVE);
> +       return 0;
> +}
> +
> +int cdn_dp_reg_write_bit(struct cdn_dp_device *dp, u16 addr, u8 start_bit,
> +                        u8 bits_no, u32 val)
> +{
> +       u8 field[8];
> +
> +       field[0] = (addr >> 8) & 0xff;
> +       field[1] = addr & 0xff;
> +       field[2] = start_bit;
> +       field[3] = bits_no;
> +       field[4] = (val >> 24) & 0xff;
> +       field[5] = (val >> 16) & 0xff;
> +       field[6] = (val >> 8) & 0xff;
> +       field[7] = val & 0xff;
> +
> +       return cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_WRITE_FIELD,
> +                                  sizeof(field), field);
> +}
> +
> +int cdn_dp_set_host_cap(struct cdn_dp_device *dp, u8 lanes)
> +{
> +       u8 msg[8];
> +       int ret;
> +
> +       msg[0] = CDN_DP_MAX_LINK_RATE;
> +       msg[1] = lanes;
> +       msg[2] = VOLTAGE_LEVEL_2;
> +       msg[3] = PRE_EMPHASIS_LEVEL_3;
> +       msg[4] = PTS1 | PTS2 | PTS3 | PTS4;
> +       msg[5] = FAST_LT_NOT_SUPPORT;
> +       msg[6] = LANE_MAPPING_NORMAL;
> +       msg[7] = ENHANCED;
> +
> +       ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX,
> +                                 DPTX_SET_HOST_CAPABILITIES,
> +                                 sizeof(msg), msg);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_reg_write(dp, DP_AUX_SWAP_INVERSION_CONTROL,
> +                              AUX_HOST_INVERT);
> +       if (ret)
> +               return ret;
> +
> +       return 0;
> +}
> +
> +int cdn_dp_event_config(struct cdn_dp_device *dp)
> +{
> +       u8 msg[5];
> +
> +       memset(msg, 0, sizeof(msg));
> +
> +       msg[0] = DPTX_EVENT_ENABLE_HPD | DPTX_EVENT_ENABLE_TRAINING;
> +
> +       return cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_ENABLE_EVENT,
> +                                  sizeof(msg), msg);
> +}
> +
> +u32 cdn_dp_get_event(struct cdn_dp_device *dp)
> +{
> +       return readl(dp->regs + SW_EVENTS0);
> +}
> +
> +int cdn_dp_get_hpd_status(struct cdn_dp_device *dp)
> +{
> +       u8 status;
> +       int ret;
> +
> +       ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_HPD_STATE,
> +                                 0, NULL);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
> +                                             DPTX_HPD_STATE, sizeof(status));
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_read_receive(dp, &status, sizeof(status));
> +       if (ret)
> +               return ret;
> +
> +       return status;
> +}
> +
> +int cdn_dp_get_edid_block(void *data, u8 *edid,
> +                         unsigned int block, size_t length)
> +{
> +       struct cdn_dp_device *dp = data;
> +       u8 msg[2], reg[2];
> +       int ret;
> +
> +       msg[0] = block / 2;
> +       msg[1] = block % 2;
> +
> +       ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_GET_EDID,
> +                                 sizeof(msg), msg);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
> +                                             DPTX_GET_EDID,
> +                                             sizeof(reg) + length);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_read_receive(dp, reg, sizeof(reg));
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_read_receive(dp, edid, length);
> +       if (ret)
> +               return ret;
> +
> +       if (reg[0] != length || reg[1] != block / 2) {
> +               dev_err(dp->dev, "edid block size err\n");
> +               return -EINVAL;
> +       }
> +
> +       return 0;
> +}
> +
> +int cdn_dp_training_start(struct cdn_dp_device *dp)
> +{
> +       u8 msg, event[2];
> +       unsigned long timeout;
> +       int ret;
> +
> +       msg = LINK_TRAINING_RUN;
> +
> +       /* start training */
> +       ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_TRAINING_CONTROL,
> +                                 sizeof(msg), &msg);
> +       if (ret)
> +               return ret;
> +
> +       timeout = jiffies + msecs_to_jiffies(LINK_TRAINING_TIMEOUT_MS);
> +       while (time_before(jiffies, timeout)) {
> +               msleep(LINK_TRAINING_RETRY_MS);
> +               ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX,
> +                                         DPTX_READ_EVENT, 0, NULL);
> +               if (ret)
> +                       return ret;
> +
> +               ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
> +                                                     DPTX_READ_EVENT,
> +                                                     sizeof(event));
> +               if (ret)
> +                       return ret;
> +
> +               ret = cdn_dp_mailbox_read_receive(dp, event, sizeof(event));
> +               if (ret)
> +                       return ret;
> +
> +               if (event[1] & EQ_PHASE_FINISHED)
> +                       return 0;
> +       }
> +
> +       return -ETIMEDOUT;
> +}
> +
> +int cdn_dp_get_training_status(struct cdn_dp_device *dp)
> +{
> +       u8 status[10];
> +       int ret;
> +
> +       ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_READ_LINK_STAT,
> +                                 0, NULL);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
> +                                             DPTX_READ_LINK_STAT,
> +                                             sizeof(status));
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_mailbox_read_receive(dp, status, sizeof(status));
> +       if (ret)
> +               return ret;
> +
> +       dp->link.rate = status[0];
> +       dp->link.num_lanes = status[1];
> +
> +       return 0;
> +}
> +
> +int cdn_dp_set_video_status(struct cdn_dp_device *dp, int active)
> +{
> +       u8 msg;
> +
> +       msg = !!active;
> +
> +       return cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_SET_VIDEO,
> +                                  sizeof(msg), &msg);
> +}
> +
> +static int cdn_dp_get_msa_misc(struct video_info *video,
> +                              struct drm_display_mode *mode)
> +{
> +       u8 val[2];
> +       u32 msa_misc;
> +
> +       switch (video->color_fmt) {
> +       case PXL_RGB:
> +       case Y_ONLY:
> +               val[0] = 0;
> +               break;
> +       /* set YUV default color space conversion to BT601 */
> +       case YCBCR_4_4_4:
> +               val[0] = 6 + BT_601 * 8;
> +               break;
> +       case YCBCR_4_2_2:
> +               val[0] = 5 + BT_601 * 8;
> +               break;
> +       case YCBCR_4_2_0:
> +               val[0] = 5;
> +               break;
> +       };
> +
> +       switch (video->color_depth) {
> +       case 6:
> +               val[1] = 0;
> +               break;
> +       case 8:
> +               val[1] = 1;
> +               break;
> +       case 10:
> +               val[1] = 2;
> +               break;
> +       case 12:
> +               val[1] = 3;
> +               break;
> +       case 16:
> +               val[1] = 4;
> +               break;
> +       };
> +
> +       msa_misc = 2 * val[0] + 32 * val[1] +
> +                  ((video->color_fmt == Y_ONLY) ? (1 << 14) : 0);
> +
> +       return msa_misc;
> +}
> +
> +int cdn_dp_config_video(struct cdn_dp_device *dp)
> +{
> +       struct video_info *video = &dp->video_info;
> +       struct drm_display_mode *mode = &dp->mode;
> +       u64 symbol, tmp;
> +       u32 val, link_rate;
> +       u8 bit_per_pix;
> +       u8 tu_size_reg = TU_SIZE;
> +       int ret;
> +
> +       bit_per_pix = (video->color_fmt == YCBCR_4_2_2) ?
> +                     (video->color_depth * 2) : (video->color_depth * 3);
> +
> +       link_rate = drm_dp_bw_code_to_link_rate(dp->link.rate) / 1000;
> +
> +       val = VIF_BYPASS_INTERLACE;
> +       ret = cdn_dp_reg_write(dp, BND_HSYNC2VSYNC, val);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_reg_write(dp, HSYNC2VSYNC_POL_CTRL, 0);
> +       if (ret)
> +               return ret;
> +
> +       /*
> +        * get a best tu_size and valid symbol:
> +        * 1. chose Lclk freq(162Mhz, 270Mhz, 540Mhz), set TU to 32
> +        * 2. calculate VS(valid symbol) = TU * Pclk * Bpp / (Lclk * Lanes)
> +        * 3. if VS > *.85 or VS < *.1 or VS < 2 or TU < VS + 4, then set
> +        *    TU += 2 and repeat 2nd step.
> +        */
> +       do {
> +               tu_size_reg += 2;
> +               tmp = tu_size_reg * mode->clock * bit_per_pix;
> +               tmp /= dp->link.num_lanes * link_rate * 8;
> +               symbol = tmp / 1000;
> +       } while ((symbol <= 1) || (tu_size_reg - symbol < 4) ||
> +                (tmp % 1000 > 850) || (tmp % 1000 < 100));
> +
> +       val = symbol + (tu_size_reg << 8);
> +       ret = cdn_dp_reg_write(dp, DP_FRAMER_TU, val);
> +       if (ret)
> +               return ret;
> +
> +       /* set the FIFO Buffer size */
> +       val = ((mode->clock * (symbol + 1) / 1000) + link_rate);
> +       val /= (dp->link.num_lanes * link_rate);
> +       val = 8 * (symbol + 1) / bit_per_pix - val;
> +       val += 2;
> +       ret = cdn_dp_reg_write(dp, DP_VC_TABLE(15), val);
> +
> +       switch (video->color_depth) {
> +       case 6:
> +               val = BCS_6;
> +               break;
> +       case 8:
> +               val = BCS_8;
> +               break;
> +       case 10:
> +               val = BCS_10;
> +               break;
> +       case 12:
> +               val = BCS_12;
> +               break;
> +       case 16:
> +               val = BCS_16;
> +               break;
> +       };
> +
> +       val += video->color_fmt << 8;
> +       ret = cdn_dp_reg_write(dp, DP_FRAMER_PXL_REPR, val);
> +       if (ret)
> +               return ret;
> +
> +       val = video->h_sync_polarity ? DP_FRAMER_SP_HSP : 0;
> +       val |= video->v_sync_polarity ? DP_FRAMER_SP_VSP : 0;
> +       ret = cdn_dp_reg_write(dp, DP_FRAMER_SP, val);
> +       if (ret)
> +               return ret;
> +
> +       val = (mode->hsync_start - mode->hdisplay) << 16;
> +       val |= mode->htotal - mode->hsync_end;
> +       ret = cdn_dp_reg_write(dp, DP_FRONT_BACK_PORCH, val);
> +       if (ret)
> +               return ret;
> +
> +       val = mode->hdisplay * bit_per_pix / 8;
> +       ret = cdn_dp_reg_write(dp, DP_BYTE_COUNT, val);
> +       if (ret)
> +               return ret;
> +
> +       val = mode->htotal | ((mode->htotal - mode->hsync_start) << 16);
> +       ret = cdn_dp_reg_write(dp, MSA_HORIZONTAL_0, val);
> +       if (ret)
> +               return ret;
> +
> +       val = mode->hsync_end - mode->hsync_start;
> +       val |= (mode->hdisplay << 16) | (video->h_sync_polarity << 15);
> +       ret = cdn_dp_reg_write(dp, MSA_HORIZONTAL_1, val);
> +       if (ret)
> +               return ret;
> +
> +       val = mode->vtotal;
> +       val |= ((mode->vtotal - mode->vsync_start) << 16);
> +       ret = cdn_dp_reg_write(dp, MSA_VERTICAL_0, val);
> +       if (ret)
> +               return ret;
> +
> +       val = mode->vsync_end - mode->vsync_start;
> +       val |= mode->vdisplay << 16 | (video->v_sync_polarity << 15);
> +       ret = cdn_dp_reg_write(dp, MSA_VERTICAL_1, val);
> +       if (ret)
> +               return ret;
> +
> +       val = cdn_dp_get_msa_misc(video, mode);
> +       ret = cdn_dp_reg_write(dp, MSA_MISC, val);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_reg_write(dp, STREAM_CONFIG, 1);
> +       if (ret)
> +               return ret;
> +
> +       val = mode->hsync_end - mode->hsync_start;
> +       val |= (mode->hdisplay << 16);
> +       ret = cdn_dp_reg_write(dp, DP_HORIZONTAL, val);
> +       if (ret)
> +               return ret;
> +
> +       val = mode->vtotal;
> +       val -= (mode->vtotal - mode->vdisplay);
> +       val |= (mode->vtotal - mode->vsync_start) << 16;
> +       ret = cdn_dp_reg_write(dp, DP_VERTICAL_0, val);
> +       if (ret)
> +               return ret;
> +
> +       val = mode->vtotal;
> +       ret = cdn_dp_reg_write(dp, DP_VERTICAL_1, val);
> +       if (ret)
> +               return ret;
> +
> +       val =  0;
> +       return cdn_dp_reg_write_bit(dp, DP_VB_ID, 2, 1, val);
> +}
> +
> +int cdn_dp_audio_stop(struct cdn_dp_device *dp, struct audio_info *audio)
> +{
> +       u32 val;
> +       int ret;
> +
> +       ret = cdn_dp_reg_write(dp, AUDIO_PACK_CONTROL, 0);
> +       if (ret)
> +               return ret;
> +
> +       val = SPDIF_AVG_SEL | SPDIF_JITTER_BYPASS;
> +       val |= SPDIF_FIFO_MID_RANGE(0xe0);
> +       val |= SPDIF_JITTER_THRSH(0xe0);
> +       val |= SPDIF_JITTER_AVG_WIN(7);
> +       writel(val, dp->regs + SPDIF_CTRL_ADDR);
> +
> +       /* clearn the audio config and reset */
> +       writel(0, dp->regs + AUDIO_SRC_CNTL);
> +       writel(0, dp->regs + AUDIO_SRC_CNFG);
> +       writel(AUDIO_SW_RST, dp->regs + AUDIO_SRC_CNTL);
> +       writel(0, dp->regs + AUDIO_SRC_CNTL);
> +
> +       /* reset smpl2pckt component  */
> +       writel(0, dp->regs + SMPL2PKT_CNTL);
> +       writel(AUDIO_SW_RST, dp->regs + SMPL2PKT_CNTL);
> +       writel(0, dp->regs + SMPL2PKT_CNTL);
> +
> +       /* reset FIFO */
> +       writel(AUDIO_SW_RST, dp->regs + FIFO_CNTL);
> +       writel(0, dp->regs + FIFO_CNTL);
> +
> +       if (audio->format == AFMT_SPDIF)
> +               clk_disable_unprepare(dp->spdif_clk);
> +
> +       return 0;
> +}
> +
> +int cdn_dp_audio_mute(struct cdn_dp_device *dp, bool enable)
> +{
> +       return cdn_dp_reg_write_bit(dp, DP_VB_ID, 4, 1, enable);
> +}
> +
> +static void cdn_dp_audio_config_i2s(struct cdn_dp_device *dp,
> +                                   struct audio_info *audio)
> +{
> +       int sub_pckt_num = 1, i2s_port_en_val = 0xf, i;
> +       u32 val;
> +
> +       if (audio->channels == 2) {
> +               if (dp->link.num_lanes == 1)
> +                       sub_pckt_num = 2;
> +               else
> +                       sub_pckt_num = 4;
> +
> +               i2s_port_en_val = 1;
> +       } else if (audio->channels == 4) {
> +               i2s_port_en_val = 3;
> +       }
> +
> +       writel(0x0, dp->regs + SPDIF_CTRL_ADDR);
> +
> +       writel(SYNC_WR_TO_CH_ZERO, dp->regs + FIFO_CNTL);
> +
> +       val = MAX_NUM_CH(audio->channels);
> +       val |= NUM_OF_I2S_PORTS(audio->channels);
> +       val |= AUDIO_TYPE_LPCM;
> +       val |= CFG_SUB_PCKT_NUM(sub_pckt_num);
> +       writel(val, dp->regs + SMPL2PKT_CNFG);
> +
> +       if (audio->sample_width == 16)
> +               val = 0;
> +       else if (audio->sample_width == 24)
> +               val = 1 << 9;
> +       else
> +               val = 2 << 9;
> +
> +       val |= AUDIO_CH_NUM(audio->channels);
> +       val |= I2S_DEC_PORT_EN(i2s_port_en_val);
> +       val |= TRANS_SMPL_WIDTH_32;
> +       writel(val, dp->regs + AUDIO_SRC_CNFG);
> +
> +       for (i = 0; i < (audio->channels + 1) / 2; i++) {
> +               if (audio->sample_width == 16)
> +                       val = (0x08 << 8) | (0x08 << 20);
> +               else if (audio->sample_width == 24)
> +                       val = (0x0b << 8) | (0x0b << 20);
> +
> +               val |= ((2 * i) << 4) | ((2 * i + 1) << 16);
> +               writel(val, dp->regs + STTS_BIT_CH(i));
> +       }
> +
> +       switch (audio->sample_rate) {
> +       case 32000:
> +               val = SAMPLING_FREQ(3) |
> +                     ORIGINAL_SAMP_FREQ(0xc);
> +               break;
> +       case 44100:
> +               val = SAMPLING_FREQ(0) |
> +                     ORIGINAL_SAMP_FREQ(0xf);
> +               break;
> +       case 48000:
> +               val = SAMPLING_FREQ(2) |
> +                     ORIGINAL_SAMP_FREQ(0xd);
> +               break;
> +       case 88200:
> +               val = SAMPLING_FREQ(8) |
> +                     ORIGINAL_SAMP_FREQ(0x7);
> +               break;
> +       case 96000:
> +               val = SAMPLING_FREQ(0xa) |
> +                     ORIGINAL_SAMP_FREQ(5);
> +               break;
> +       case 176400:
> +               val = SAMPLING_FREQ(0xc) |
> +                     ORIGINAL_SAMP_FREQ(3);
> +               break;
> +       case 192000:
> +               val = SAMPLING_FREQ(0xe) |
> +                     ORIGINAL_SAMP_FREQ(1);
> +               break;
> +       }
> +       val |= 4;
> +       writel(val, dp->regs + COM_CH_STTS_BITS);
> +
> +       writel(SMPL2PKT_EN, dp->regs + SMPL2PKT_CNTL);
> +       writel(I2S_DEC_START, dp->regs + AUDIO_SRC_CNTL);
> +}
> +
> +static void cdn_dp_audio_config_spdif(struct cdn_dp_device *dp)
> +{
> +       u32 val;
> +
> +       val = SPDIF_AVG_SEL | SPDIF_JITTER_BYPASS;
> +       val |= SPDIF_FIFO_MID_RANGE(0xe0);
> +       val |= SPDIF_JITTER_THRSH(0xe0);
> +       val |= SPDIF_JITTER_AVG_WIN(7);
> +       writel(val, dp->regs + SPDIF_CTRL_ADDR);
> +
> +       writel(SYNC_WR_TO_CH_ZERO, dp->regs + FIFO_CNTL);
> +
> +       val = MAX_NUM_CH(2) | AUDIO_TYPE_LPCM | CFG_SUB_PCKT_NUM(4);
> +       writel(val, dp->regs + SMPL2PKT_CNFG);
> +       writel(SMPL2PKT_EN, dp->regs + SMPL2PKT_CNTL);
> +
> +       val = SPDIF_ENABLE | SPDIF_AVG_SEL | SPDIF_JITTER_BYPASS;
> +       val |= SPDIF_FIFO_MID_RANGE(0xe0);
> +       val |= SPDIF_JITTER_THRSH(0xe0);
> +       val |= SPDIF_JITTER_AVG_WIN(7);
> +       writel(val, dp->regs + SPDIF_CTRL_ADDR);
> +
> +       clk_prepare_enable(dp->spdif_clk);
> +       clk_set_rate(dp->spdif_clk, CDN_DP_SPDIF_CLK);
> +}
> +
> +int cdn_dp_audio_config_set(struct cdn_dp_device *dp, struct audio_info *audio)
> +{
> +       int ret;
> +
> +       /* reset the spdif clk before config */
> +       if (audio->format == AFMT_SPDIF) {
> +               reset_control_assert(dp->spdif_rst);
> +               reset_control_deassert(dp->spdif_rst);
> +       }
> +
> +       ret = cdn_dp_reg_write(dp, CM_LANE_CTRL, LANE_REF_CYC);
> +       if (ret)
> +               return ret;
> +
> +       ret = cdn_dp_reg_write(dp, CM_CTRL, 0);
> +       if (ret)
> +               return ret;
> +
> +       if (audio->format == AFMT_I2S)
> +               cdn_dp_audio_config_i2s(dp, audio);
> +       else
> +               cdn_dp_audio_config_spdif(dp);
> +
> +       return cdn_dp_reg_write(dp, AUDIO_PACK_CONTROL, AUDIO_PACK_EN);
> +}
> diff --git a/drivers/gpu/drm/rockchip/cdn-dp-reg.h b/drivers/gpu/drm/rockchip/cdn-dp-reg.h
> new file mode 100644
> index 0000000..e83aebd
> --- /dev/null
> +++ b/drivers/gpu/drm/rockchip/cdn-dp-reg.h
> @@ -0,0 +1,482 @@
> +/*
> + * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
> + * Author: Chris Zhong <zyw at rock-chips.com>
> + *
> + * This software is licensed under the terms of the GNU General Public
> + * License version 2, as published by the Free Software Foundation, and
> + * may be copied, distributed, and modified under those terms.
> + *
> + * This program is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> + * GNU General Public License for more details.
> + */
> +
> +#ifndef _CDN_DP_REG_H
> +#define _CDN_DP_REG_H
> +
> +#include <linux/bitops.h>
> +
> +#define ADDR_IMEM              0x10000
> +#define ADDR_DMEM              0x20000
> +
> +/* APB CFG addr */
> +#define APB_CTRL                       0
> +#define XT_INT_CTRL                    0x04
> +#define MAILBOX_FULL_ADDR              0x08
> +#define MAILBOX_EMPTY_ADDR             0x0c
> +#define MAILBOX0_WR_DATA               0x10
> +#define MAILBOX0_RD_DATA               0x14
> +#define KEEP_ALIVE                     0x18
> +#define VER_L                          0x1c
> +#define VER_H                          0x20
> +#define VER_LIB_L_ADDR                 0x24
> +#define VER_LIB_H_ADDR                 0x28
> +#define SW_DEBUG_L                     0x2c
> +#define SW_DEBUG_H                     0x30
> +#define MAILBOX_INT_MASK               0x34
> +#define MAILBOX_INT_STATUS             0x38
> +#define SW_CLK_L                       0x3c
> +#define SW_CLK_H                       0x40
> +#define SW_EVENTS0                     0x44
> +#define SW_EVENTS1                     0x48
> +#define SW_EVENTS2                     0x4c
> +#define SW_EVENTS3                     0x50
> +#define XT_OCD_CTRL                    0x60
> +#define APB_INT_MASK                   0x6c
> +#define APB_STATUS_MASK                        0x70
> +
> +/* audio decoder addr */
> +#define AUDIO_SRC_CNTL                 0x30000
> +#define AUDIO_SRC_CNFG                 0x30004
> +#define COM_CH_STTS_BITS               0x30008
> +#define STTS_BIT_CH(x)                 (0x3000c + ((x) << 2))
> +#define SPDIF_CTRL_ADDR                        0x3004c
> +#define SPDIF_CH1_CS_3100_ADDR         0x30050
> +#define SPDIF_CH1_CS_6332_ADDR         0x30054
> +#define SPDIF_CH1_CS_9564_ADDR         0x30058
> +#define SPDIF_CH1_CS_12796_ADDR                0x3005c
> +#define SPDIF_CH1_CS_159128_ADDR       0x30060
> +#define SPDIF_CH1_CS_191160_ADDR       0x30064
> +#define SPDIF_CH2_CS_3100_ADDR         0x30068
> +#define SPDIF_CH2_CS_6332_ADDR         0x3006c
> +#define SPDIF_CH2_CS_9564_ADDR         0x30070
> +#define SPDIF_CH2_CS_12796_ADDR                0x30074
> +#define SPDIF_CH2_CS_159128_ADDR       0x30078
> +#define SPDIF_CH2_CS_191160_ADDR       0x3007c
> +#define SMPL2PKT_CNTL                  0x30080
> +#define SMPL2PKT_CNFG                  0x30084
> +#define FIFO_CNTL                      0x30088
> +#define FIFO_STTS                      0x3008c
> +
> +/* source pif addr */
> +#define SOURCE_PIF_WR_ADDR             0x30800
> +#define SOURCE_PIF_WR_REQ              0x30804
> +#define SOURCE_PIF_RD_ADDR             0x30808
> +#define SOURCE_PIF_RD_REQ              0x3080c
> +#define SOURCE_PIF_DATA_WR             0x30810
> +#define SOURCE_PIF_DATA_RD             0x30814
> +#define SOURCE_PIF_FIFO1_FLUSH         0x30818
> +#define SOURCE_PIF_FIFO2_FLUSH         0x3081c
> +#define SOURCE_PIF_STATUS              0x30820
> +#define SOURCE_PIF_INTERRUPT_SOURCE    0x30824
> +#define SOURCE_PIF_INTERRUPT_MASK      0x30828
> +#define SOURCE_PIF_PKT_ALLOC_REG       0x3082c
> +#define SOURCE_PIF_PKT_ALLOC_WR_EN     0x30830
> +#define SOURCE_PIF_SW_RESET            0x30834
> +
> +/* bellow registers need access by mailbox */
> +/* source car addr */
> +#define SOURCE_HDTX_CAR                        0x0900
> +#define SOURCE_DPTX_CAR                        0x0904
> +#define SOURCE_PHY_CAR                 0x0908
> +#define SOURCE_CEC_CAR                 0x090c
> +#define SOURCE_CBUS_CAR                        0x0910
> +#define SOURCE_PKT_CAR                 0x0918
> +#define SOURCE_AIF_CAR                 0x091c
> +#define SOURCE_CIPHER_CAR              0x0920
> +#define SOURCE_CRYPTO_CAR              0x0924
> +
> +/* clock meters addr */
> +#define CM_CTRL                                0x0a00
> +#define CM_I2S_CTRL                    0x0a04
> +#define CM_SPDIF_CTRL                  0x0a08
> +#define CM_VID_CTRL                    0x0a0c
> +#define CM_LANE_CTRL                   0x0a10
> +#define I2S_NM_STABLE                  0x0a14
> +#define I2S_NCTS_STABLE                        0x0a18
> +#define SPDIF_NM_STABLE                        0x0a1c
> +#define SPDIF_NCTS_STABLE              0x0a20
> +#define NMVID_MEAS_STABLE              0x0a24
> +#define I2S_MEAS                       0x0a40
> +#define SPDIF_MEAS                     0x0a80
> +#define NMVID_MEAS                     0x0ac0
> +
> +/* source vif addr */
> +#define BND_HSYNC2VSYNC                        0x0b00
> +#define HSYNC2VSYNC_F1_L1              0x0b04
> +#define HSYNC2VSYNC_F2_L1              0x0b08
> +#define HSYNC2VSYNC_STATUS             0x0b0c
> +#define HSYNC2VSYNC_POL_CTRL           0x0b10
> +
> +/* dptx phy addr */
> +#define DP_TX_PHY_CONFIG_REG           0x2000
> +#define DP_TX_PHY_STATUS_REG           0x2004
> +#define DP_TX_PHY_SW_RESET             0x2008
> +#define DP_TX_PHY_SCRAMBLER_SEED       0x200c
> +#define DP_TX_PHY_TRAINING_01_04       0x2010
> +#define DP_TX_PHY_TRAINING_05_08       0x2014
> +#define DP_TX_PHY_TRAINING_09_10       0x2018
> +#define TEST_COR                       0x23fc
> +
> +/* dptx hpd addr */
> +#define HPD_IRQ_DET_MIN_TIMER          0x2100
> +#define HPD_IRQ_DET_MAX_TIMER          0x2104
> +#define HPD_UNPLGED_DET_MIN_TIMER      0x2108
> +#define HPD_STABLE_TIMER               0x210c
> +#define HPD_FILTER_TIMER               0x2110
> +#define HPD_EVENT_MASK                 0x211c
> +#define HPD_EVENT_DET                  0x2120
> +
> +/* dpyx framer addr */
> +#define DP_FRAMER_GLOBAL_CONFIG                0x2200
> +#define DP_SW_RESET                    0x2204
> +#define DP_FRAMER_TU                   0x2208
> +#define DP_FRAMER_PXL_REPR             0x220c
> +#define DP_FRAMER_SP                   0x2210
> +#define AUDIO_PACK_CONTROL             0x2214
> +#define DP_VC_TABLE(x)                 (0x2218 + ((x) << 2))
> +#define DP_VB_ID                       0x2258
> +#define DP_MTPH_LVP_CONTROL            0x225c
> +#define DP_MTPH_SYMBOL_VALUES          0x2260
> +#define DP_MTPH_ECF_CONTROL            0x2264
> +#define DP_MTPH_ACT_CONTROL            0x2268
> +#define DP_MTPH_STATUS                 0x226c
> +#define DP_INTERRUPT_SOURCE            0x2270
> +#define DP_INTERRUPT_MASK              0x2274
> +#define DP_FRONT_BACK_PORCH            0x2278
> +#define DP_BYTE_COUNT                  0x227c
> +
> +/* dptx stream addr */
> +#define MSA_HORIZONTAL_0               0x2280
> +#define MSA_HORIZONTAL_1               0x2284
> +#define MSA_VERTICAL_0                 0x2288
> +#define MSA_VERTICAL_1                 0x228c
> +#define MSA_MISC                       0x2290
> +#define STREAM_CONFIG                  0x2294
> +#define AUDIO_PACK_STATUS              0x2298
> +#define VIF_STATUS                     0x229c
> +#define PCK_STUFF_STATUS_0             0x22a0
> +#define PCK_STUFF_STATUS_1             0x22a4
> +#define INFO_PACK_STATUS               0x22a8
> +#define RATE_GOVERNOR_STATUS           0x22ac
> +#define DP_HORIZONTAL                  0x22b0
> +#define DP_VERTICAL_0                  0x22b4
> +#define DP_VERTICAL_1                  0x22b8
> +#define DP_BLOCK_SDP                   0x22bc
> +
> +/* dptx glbl addr */
> +#define DPTX_LANE_EN                   0x2300
> +#define DPTX_ENHNCD                    0x2304
> +#define DPTX_INT_MASK                  0x2308
> +#define DPTX_INT_STATUS                        0x230c
> +
> +/* dp aux addr */
> +#define DP_AUX_HOST_CONTROL            0x2800
> +#define DP_AUX_INTERRUPT_SOURCE                0x2804
> +#define DP_AUX_INTERRUPT_MASK          0x2808
> +#define DP_AUX_SWAP_INVERSION_CONTROL  0x280c
> +#define DP_AUX_SEND_NACK_TRANSACTION   0x2810
> +#define DP_AUX_CLEAR_RX                        0x2814
> +#define DP_AUX_CLEAR_TX                        0x2818
> +#define DP_AUX_TIMER_STOP              0x281c
> +#define DP_AUX_TIMER_CLEAR             0x2820
> +#define DP_AUX_RESET_SW                        0x2824
> +#define DP_AUX_DIVIDE_2M               0x2828
> +#define DP_AUX_TX_PREACHARGE_LENGTH    0x282c
> +#define DP_AUX_FREQUENCY_1M_MAX                0x2830
> +#define DP_AUX_FREQUENCY_1M_MIN                0x2834
> +#define DP_AUX_RX_PRE_MIN              0x2838
> +#define DP_AUX_RX_PRE_MAX              0x283c
> +#define DP_AUX_TIMER_PRESET            0x2840
> +#define DP_AUX_NACK_FORMAT             0x2844
> +#define DP_AUX_TX_DATA                 0x2848
> +#define DP_AUX_RX_DATA                 0x284c
> +#define DP_AUX_TX_STATUS               0x2850
> +#define DP_AUX_RX_STATUS               0x2854
> +#define DP_AUX_RX_CYCLE_COUNTER                0x2858
> +#define DP_AUX_MAIN_STATES             0x285c
> +#define DP_AUX_MAIN_TIMER              0x2860
> +#define DP_AUX_AFE_OUT                 0x2864
> +
> +/* crypto addr */
> +#define CRYPTO_HDCP_REVISION           0x5800
> +#define HDCP_CRYPTO_CONFIG             0x5804
> +#define CRYPTO_INTERRUPT_SOURCE                0x5808
> +#define CRYPTO_INTERRUPT_MASK          0x580c
> +#define CRYPTO22_CONFIG                        0x5818
> +#define CRYPTO22_STATUS                        0x581c
> +#define SHA_256_DATA_IN                        0x583c
> +#define SHA_256_DATA_OUT_(x)           (0x5850 + ((x) << 2))
> +#define AES_32_KEY_(x)                 (0x5870 + ((x) << 2))
> +#define AES_32_DATA_IN                 0x5880
> +#define AES_32_DATA_OUT_(x)            (0x5884 + ((x) << 2))
> +#define CRYPTO14_CONFIG                        0x58a0
> +#define CRYPTO14_STATUS                        0x58a4
> +#define CRYPTO14_PRNM_OUT              0x58a8
> +#define CRYPTO14_KM_0                  0x58ac
> +#define CRYPTO14_KM_1                  0x58b0
> +#define CRYPTO14_AN_0                  0x58b4
> +#define CRYPTO14_AN_1                  0x58b8
> +#define CRYPTO14_YOUR_KSV_0            0x58bc
> +#define CRYPTO14_YOUR_KSV_1            0x58c0
> +#define CRYPTO14_MI_0                  0x58c4
> +#define CRYPTO14_MI_1                  0x58c8
> +#define CRYPTO14_TI_0                  0x58cc
> +#define CRYPTO14_KI_0                  0x58d0
> +#define CRYPTO14_KI_1                  0x58d4
> +#define CRYPTO14_BLOCKS_NUM            0x58d8
> +#define CRYPTO14_KEY_MEM_DATA_0                0x58dc
> +#define CRYPTO14_KEY_MEM_DATA_1                0x58e0
> +#define CRYPTO14_SHA1_MSG_DATA         0x58e4
> +#define CRYPTO14_SHA1_V_VALUE_(x)      (0x58e8 + ((x) << 2))
> +#define TRNG_CTRL                      0x58fc
> +#define TRNG_DATA_RDY                  0x5900
> +#define TRNG_DATA                      0x5904
> +
> +/* cipher addr */
> +#define HDCP_REVISION                  0x60000
> +#define INTERRUPT_SOURCE               0x60004
> +#define INTERRUPT_MASK                 0x60008
> +#define HDCP_CIPHER_CONFIG             0x6000c
> +#define AES_128_KEY_0                  0x60010
> +#define AES_128_KEY_1                  0x60014
> +#define AES_128_KEY_2                  0x60018
> +#define AES_128_KEY_3                  0x6001c
> +#define AES_128_RANDOM_0               0x60020
> +#define AES_128_RANDOM_1               0x60024
> +#define CIPHER14_KM_0                  0x60028
> +#define CIPHER14_KM_1                  0x6002c
> +#define CIPHER14_STATUS                        0x60030
> +#define CIPHER14_RI_PJ_STATUS          0x60034
> +#define CIPHER_MODE                    0x60038
> +#define CIPHER14_AN_0                  0x6003c
> +#define CIPHER14_AN_1                  0x60040
> +#define CIPHER22_AUTH                  0x60044
> +#define CIPHER14_R0_DP_STATUS          0x60048
> +#define CIPHER14_BOOTSTRAP             0x6004c
> +
> +#define DPTX_FRMR_DATA_CLK_RSTN_EN     BIT(11)
> +#define DPTX_FRMR_DATA_CLK_EN          BIT(10)
> +#define DPTX_PHY_DATA_RSTN_EN          BIT(9)
> +#define DPTX_PHY_DATA_CLK_EN           BIT(8)
> +#define DPTX_PHY_CHAR_RSTN_EN          BIT(7)
> +#define DPTX_PHY_CHAR_CLK_EN           BIT(6)
> +#define SOURCE_AUX_SYS_CLK_RSTN_EN     BIT(5)
> +#define SOURCE_AUX_SYS_CLK_EN          BIT(4)
> +#define DPTX_SYS_CLK_RSTN_EN           BIT(3)
> +#define DPTX_SYS_CLK_EN                        BIT(2)
> +#define CFG_DPTX_VIF_CLK_RSTN_EN       BIT(1)
> +#define CFG_DPTX_VIF_CLK_EN            BIT(0)
> +
> +#define SOURCE_PHY_RSTN_EN             BIT(1)
> +#define SOURCE_PHY_CLK_EN              BIT(0)
> +
> +#define SOURCE_PKT_SYS_RSTN_EN         BIT(3)
> +#define SOURCE_PKT_SYS_CLK_EN          BIT(2)
> +#define SOURCE_PKT_DATA_RSTN_EN                BIT(1)
> +#define SOURCE_PKT_DATA_CLK_EN         BIT(0)
> +
> +#define SPDIF_CDR_CLK_RSTN_EN          BIT(5)
> +#define SPDIF_CDR_CLK_EN               BIT(4)
> +#define SOURCE_AIF_SYS_RSTN_EN         BIT(3)
> +#define SOURCE_AIF_SYS_CLK_EN          BIT(2)
> +#define SOURCE_AIF_CLK_RSTN_EN         BIT(1)
> +#define SOURCE_AIF_CLK_EN              BIT(0)
> +
> +#define SOURCE_CIPHER_SYSTEM_CLK_RSTN_EN       BIT(3)
> +#define SOURCE_CIPHER_SYS_CLK_EN               BIT(2)
> +#define SOURCE_CIPHER_CHAR_CLK_RSTN_EN         BIT(1)
> +#define SOURCE_CIPHER_CHAR_CLK_EN              BIT(0)
> +
> +#define SOURCE_CRYPTO_SYS_CLK_RSTN_EN  BIT(1)
> +#define SOURCE_CRYPTO_SYS_CLK_EN       BIT(0)
> +
> +#define APB_IRAM_PATH                  BIT(2)
> +#define APB_DRAM_PATH                  BIT(1)
> +#define APB_XT_RESET                   BIT(0)
> +
> +#define MAILBOX_INT_MASK_BIT           BIT(1)
> +#define PIF_INT_MASK_BIT               BIT(0)
> +#define ALL_INT_MASK                   3
> +
> +/* mailbox */
> +#define MB_OPCODE_ID                   0
> +#define MB_MODULE_ID                   1
> +#define MB_SIZE_MSB_ID                 2
> +#define MB_SIZE_LSB_ID                 3
> +#define MB_DATA_ID                     4
> +
> +#define MB_MODULE_ID_DP_TX             0x01
> +#define MB_MODULE_ID_HDCP_TX           0x07
> +#define MB_MODULE_ID_HDCP_RX           0x08
> +#define MB_MODULE_ID_HDCP_GENERAL      0x09
> +#define MB_MODULE_ID_GENERAL           0x0a
> +
> +/* general opcode */
> +#define GENERAL_MAIN_CONTROL            0x01
> +#define GENERAL_TEST_ECHO               0x02
> +#define GENERAL_BUS_SETTINGS            0x03
> +#define GENERAL_TEST_ACCESS             0x04
> +
> +#define DPTX_SET_POWER_MNG                     0x00
> +#define DPTX_SET_HOST_CAPABILITIES             0x01
> +#define DPTX_GET_EDID                          0x02
> +#define DPTX_READ_DPCD                         0x03
> +#define DPTX_WRITE_DPCD                                0x04
> +#define DPTX_ENABLE_EVENT                      0x05
> +#define DPTX_WRITE_REGISTER                    0x06
> +#define DPTX_READ_REGISTER                     0x07
> +#define DPTX_WRITE_FIELD                       0x08
> +#define DPTX_TRAINING_CONTROL                  0x09
> +#define DPTX_READ_EVENT                                0x0a
> +#define DPTX_READ_LINK_STAT                    0x0b
> +#define DPTX_SET_VIDEO                         0x0c
> +#define DPTX_SET_AUDIO                         0x0d
> +#define DPTX_GET_LAST_AUX_STAUS                        0x0e
> +#define DPTX_SET_LINK_BREAK_POINT              0x0f
> +#define DPTX_FORCE_LANES                       0x10
> +#define DPTX_HPD_STATE                         0x11
> +
> +#define FW_STANDBY                             0
> +#define FW_ACTIVE                              1
> +
> +#define DPTX_EVENT_ENABLE_HPD                  BIT(0)
> +#define DPTX_EVENT_ENABLE_TRAINING             BIT(1)
> +
> +#define LINK_TRAINING_NOT_ACTIVE               0
> +#define LINK_TRAINING_RUN                      1
> +#define LINK_TRAINING_RESTART                  2
> +
> +#define CONTROL_VIDEO_IDLE                     0
> +#define CONTROL_VIDEO_VALID                    1
> +
> +#define VIF_BYPASS_INTERLACE                   BIT(13)
> +#define INTERLACE_FMT_DET                      BIT(12)
> +#define INTERLACE_DTCT_WIN                     0x20
> +
> +#define DP_FRAMER_SP_INTERLACE_EN              BIT(2)
> +#define DP_FRAMER_SP_HSP                       BIT(1)
> +#define DP_FRAMER_SP_VSP                       BIT(0)
> +
> +/* capability */
> +#define AUX_HOST_INVERT                                3
> +#define        FAST_LT_SUPPORT                         1
> +#define FAST_LT_NOT_SUPPORT                    0
> +#define LANE_MAPPING_NORMAL                    0xe4
> +#define LANE_MAPPING_FLIPPED                   0x1b
> +#define ENHANCED                               1
> +
> +#define        FULL_LT_STARTED                         BIT(0)
> +#define FASE_LT_STARTED                                BIT(1)
> +#define CLK_RECOVERY_FINISHED                  BIT(2)
> +#define EQ_PHASE_FINISHED                      BIT(3)
> +#define FASE_LT_START_FINISHED                 BIT(4)
> +#define CLK_RECOVERY_FAILED                    BIT(5)
> +#define EQ_PHASE_FAILED                                BIT(6)
> +#define FASE_LT_FAILED                         BIT(7)
> +
> +#define DPTX_HPD_EVENT                         BIT(0)
> +#define DPTX_TRAINING_EVENT                    BIT(1)
> +#define HDCP_TX_STATUS_EVENT                   BIT(4)
> +#define HDCP2_TX_IS_KM_STORED_EVENT            BIT(5)
> +#define HDCP2_TX_STORE_KM_EVENT                        BIT(6)
> +#define HDCP_TX_IS_RECEIVER_ID_VALID_EVENT     BIT(7)
> +
> +#define TU_SIZE                                        30
> +#define CDN_DP_MAX_LINK_RATE                   DP_LINK_BW_5_4
> +
> +/* audio */
> +#define AUDIO_PACK_EN                          BIT(8)
> +#define SAMPLING_FREQ(x)                       (((x) & 0xf) << 16)
> +#define ORIGINAL_SAMP_FREQ(x)                  (((x) & 0xf) << 24)
> +#define SYNC_WR_TO_CH_ZERO                     BIT(1)
> +#define I2S_DEC_START                          BIT(1)
> +#define AUDIO_SW_RST                           BIT(0)
> +#define SMPL2PKT_EN                            BIT(1)
> +#define MAX_NUM_CH(x)                          (((x) & 0x1f) - 1)
> +#define NUM_OF_I2S_PORTS(x)                    ((((x) / 2 - 1) & 0x3) << 5)
> +#define AUDIO_TYPE_LPCM                                (2 << 7)
> +#define CFG_SUB_PCKT_NUM(x)                    ((((x) - 1) & 0x7) << 11)
> +#define AUDIO_CH_NUM(x)                                ((((x) - 1) & 0x1f) << 2)
> +#define TRANS_SMPL_WIDTH_16                    0
> +#define TRANS_SMPL_WIDTH_24                    BIT(11)
> +#define TRANS_SMPL_WIDTH_32                    (2 << 11)
> +#define I2S_DEC_PORT_EN(x)                     (((x) & 0xf) << 17)
> +#define SPDIF_ENABLE                           BIT(21)
> +#define SPDIF_AVG_SEL                          BIT(20)
> +#define SPDIF_JITTER_BYPASS                    BIT(19)
> +#define SPDIF_FIFO_MID_RANGE(x)                        (((x) & 0xff) << 11)
> +#define SPDIF_JITTER_THRSH(x)                  (((x) & 0xff) << 3)
> +#define SPDIF_JITTER_AVG_WIN(x)                        ((x) & 0x7)
> +
> +/* Refernce cycles when using lane clock as refernce */
> +#define LANE_REF_CYC                           0x8000
> +
> +enum voltage_swing_level {
> +       VOLTAGE_LEVEL_0,
> +       VOLTAGE_LEVEL_1,
> +       VOLTAGE_LEVEL_2,
> +       VOLTAGE_LEVEL_3,
> +};
> +
> +enum pre_emphasis_level {
> +       PRE_EMPHASIS_LEVEL_0,
> +       PRE_EMPHASIS_LEVEL_1,
> +       PRE_EMPHASIS_LEVEL_2,
> +       PRE_EMPHASIS_LEVEL_3,
> +};
> +
> +enum pattern_set {
> +       PTS1            = BIT(0),
> +       PTS2            = BIT(1),
> +       PTS3            = BIT(2),
> +       PTS4            = BIT(3),
> +       DP_NONE         = BIT(4)
> +};
> +
> +enum vic_color_depth {
> +       BCS_6 = 0x1,
> +       BCS_8 = 0x2,
> +       BCS_10 = 0x4,
> +       BCS_12 = 0x8,
> +       BCS_16 = 0x10,
> +};
> +
> +enum vic_bt_type {
> +       BT_601 = 0x0,
> +       BT_709 = 0x1,
> +};
> +
> +void cdn_dp_clock_reset(struct cdn_dp_device *dp);
> +
> +void cdn_dp_set_fw_clk(struct cdn_dp_device *dp, u32 clk);
> +int cdn_dp_load_firmware(struct cdn_dp_device *dp, const u32 *i_mem,
> +                        u32 i_size, const u32 *d_mem, u32 d_size);
> +int cdn_dp_active(struct cdn_dp_device *dp, bool enable);
> +int cdn_dp_set_host_cap(struct cdn_dp_device *dp, u8 lanes);
> +int cdn_dp_event_config(struct cdn_dp_device *dp);
> +u32 cdn_dp_get_event(struct cdn_dp_device *dp);
> +int cdn_dp_get_hpd_status(struct cdn_dp_device *dp);
> +int cdn_dp_dpcd_write(struct cdn_dp_device *dp, u32 addr, u8 value);
> +int cdn_dp_dpcd_read(struct cdn_dp_device *dp, u32 addr, u8 *data, u16 len);
> +int cdn_dp_get_edid_block(void *dp, u8 *edid,
> +                         unsigned int block, size_t length);
> +int cdn_dp_training_start(struct cdn_dp_device *dp);
> +int cdn_dp_get_training_status(struct cdn_dp_device *dp);
> +int cdn_dp_set_video_status(struct cdn_dp_device *dp, int active);
> +int cdn_dp_config_video(struct cdn_dp_device *dp);
> +int cdn_dp_audio_stop(struct cdn_dp_device *dp, struct audio_info *audio);
> +int cdn_dp_audio_mute(struct cdn_dp_device *dp, bool enable);
> +int cdn_dp_audio_config_set(struct cdn_dp_device *dp, struct audio_info *audio);
> +#endif /* _CDN_DP_REG_H */
> diff --git a/drivers/gpu/drm/rockchip/rockchip_drm_vop.c b/drivers/gpu/drm/rockchip/rockchip_drm_vop.c
> index edd7ec2..d723d8e 100644
> --- a/drivers/gpu/drm/rockchip/rockchip_drm_vop.c
> +++ b/drivers/gpu/drm/rockchip/rockchip_drm_vop.c
> @@ -969,9 +969,11 @@ static void vop_crtc_enable(struct drm_crtc *crtc)
>                 vop_dsp_hold_valid_irq_disable(vop);
>         }
>
> -       pin_pol = 0x8;
> -       pin_pol |= (adjusted_mode->flags & DRM_MODE_FLAG_NHSYNC) ? 0 : 1;
> -       pin_pol |= (adjusted_mode->flags & DRM_MODE_FLAG_NVSYNC) ? 0 : (1 << 1);
> +       pin_pol = BIT(DCLK_INVERT);
> +       pin_pol |= (adjusted_mode->flags & DRM_MODE_FLAG_NHSYNC) ?
> +                  0 : BIT(HSYNC_POSITIVE);
> +       pin_pol |= (adjusted_mode->flags & DRM_MODE_FLAG_NVSYNC) ?
> +                  0 : BIT(VSYNC_POSITIVE);
>         VOP_CTRL_SET(vop, pin_pol, pin_pol);
>
>         switch (s->output_type) {
> @@ -991,6 +993,11 @@ static void vop_crtc_enable(struct drm_crtc *crtc)
>                 VOP_CTRL_SET(vop, mipi_pin_pol, pin_pol);
>                 VOP_CTRL_SET(vop, mipi_en, 1);
>                 break;
> +       case DRM_MODE_CONNECTOR_DisplayPort:
> +               pin_pol &= ~BIT(DCLK_INVERT);
> +               VOP_CTRL_SET(vop, dp_pin_pol, pin_pol);
> +               VOP_CTRL_SET(vop, dp_en, 1);
> +               break;
>         default:
>                 DRM_ERROR("unsupport connector_type[%d]\n", s->output_type);
>         }
> diff --git a/drivers/gpu/drm/rockchip/rockchip_drm_vop.h b/drivers/gpu/drm/rockchip/rockchip_drm_vop.h
> index ff4f52e..4820a8b 100644
> --- a/drivers/gpu/drm/rockchip/rockchip_drm_vop.h
> +++ b/drivers/gpu/drm/rockchip/rockchip_drm_vop.h
> @@ -45,6 +45,7 @@ struct vop_ctrl {
>         struct vop_reg edp_en;
>         struct vop_reg hdmi_en;
>         struct vop_reg mipi_en;
> +       struct vop_reg dp_en;
>         struct vop_reg out_mode;
>         struct vop_reg dither_down;
>         struct vop_reg dither_up;
> @@ -53,6 +54,7 @@ struct vop_ctrl {
>         struct vop_reg hdmi_pin_pol;
>         struct vop_reg edp_pin_pol;
>         struct vop_reg mipi_pin_pol;
> +       struct vop_reg dp_pin_pol;
>
>         struct vop_reg htotal_pw;
>         struct vop_reg hact_st_end;
> @@ -242,6 +244,13 @@ enum scale_down_mode {
>         SCALE_DOWN_AVG = 0x1
>  };
>
> +enum vop_pol {
> +       HSYNC_POSITIVE = 0,
> +       VSYNC_POSITIVE = 1,
> +       DEN_NEGATIVE   = 2,
> +       DCLK_INVERT    = 3
> +};
> +
>  #define FRAC_16_16(mult, div)    (((mult) << 16) / (div))
>  #define SCL_FT_DEFAULT_FIXPOINT_SHIFT  12
>  #define SCL_MAX_VSKIPLINES             4
> diff --git a/drivers/gpu/drm/rockchip/rockchip_vop_reg.c b/drivers/gpu/drm/rockchip/rockchip_vop_reg.c
> index 5b1ae1f..dcf172e 100644
> --- a/drivers/gpu/drm/rockchip/rockchip_vop_reg.c
> +++ b/drivers/gpu/drm/rockchip/rockchip_vop_reg.c
> @@ -281,6 +281,7 @@ static const struct vop_data rk3288_vop = {
>  static const struct vop_ctrl rk3399_ctrl_data = {
>         .standby = VOP_REG(RK3399_SYS_CTRL, 0x1, 22),
>         .gate_en = VOP_REG(RK3399_SYS_CTRL, 0x1, 23),
> +       .dp_en = VOP_REG(RK3399_SYS_CTRL, 0x1, 11),
>         .rgb_en = VOP_REG(RK3399_SYS_CTRL, 0x1, 12),
>         .hdmi_en = VOP_REG(RK3399_SYS_CTRL, 0x1, 13),
>         .edp_en = VOP_REG(RK3399_SYS_CTRL, 0x1, 14),
> @@ -290,6 +291,7 @@ static const struct vop_ctrl rk3399_ctrl_data = {
>         .data_blank = VOP_REG(RK3399_DSP_CTRL0, 0x1, 19),
>         .out_mode = VOP_REG(RK3399_DSP_CTRL0, 0xf, 0),
>         .rgb_pin_pol = VOP_REG(RK3399_DSP_CTRL1, 0xf, 16),
> +       .dp_pin_pol = VOP_REG(RK3399_DSP_CTRL1, 0xf, 16),
>         .hdmi_pin_pol = VOP_REG(RK3399_DSP_CTRL1, 0xf, 20),
>         .edp_pin_pol = VOP_REG(RK3399_DSP_CTRL1, 0xf, 24),
>         .mipi_pin_pol = VOP_REG(RK3399_DSP_CTRL1, 0xf, 28),
> --
> 2.6.3
>



More information about the linux-arm-kernel mailing list