[v5 PATCH 5/5] drm/rockchip: cdn-dp: add cdn DP support for rk3399
Chris Zhong
zyw at rock-chips.com
Wed Jul 13 20:08:00 PDT 2016
Hi Sean
Thanks for your detailed review. I'm working to modify most of code
according to comment.
And there is reply for some comment
On 07/13/2016 09:59 PM, Sean Paul wrote:
> On Tue, Jul 12, 2016 at 8:09 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/cdn/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>
>>
>> ---
>>
>> 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.
>>
>> 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 | 9 +
>> drivers/gpu/drm/rockchip/Makefile | 1 +
>> drivers/gpu/drm/rockchip/cdn-dp-core.c | 761 ++++++++++++++++++++++++++++
>> drivers/gpu/drm/rockchip/cdn-dp-core.h | 113 +++++
>> drivers/gpu/drm/rockchip/cdn-dp-reg.c | 740 +++++++++++++++++++++++++++
>> drivers/gpu/drm/rockchip/cdn-dp-reg.h | 409 +++++++++++++++
> Could you explain the file naming convention in the rk driver? We've
> got analogix_dp-rockchip.c, dw_hdmi-rockchip.c, dw-mipi-dsi.c, and now
> cdn-dp-(core|reg).[ch]. I'm honestly not sure whether these filenames
> are consistent with the rest, but bleh.
>
cdn is the IP vendor's name
dp is the controller's name.
>> drivers/gpu/drm/rockchip/rockchip_drm_vop.c | 6 +-
>> drivers/gpu/drm/rockchip/rockchip_drm_vop.h | 2 +
>> drivers/gpu/drm/rockchip/rockchip_vop_reg.c | 2 +
>> 9 files changed, 2042 insertions(+), 1 deletion(-)
>> 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..20da9a8 100644
>> --- a/drivers/gpu/drm/rockchip/Kconfig
>> +++ b/drivers/gpu/drm/rockchip/Kconfig
>> @@ -25,6 +25,15 @@ 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
>> + help
>> + This selects support for Rockchip SoC specific extensions
>> + for the cdn Dp driver. If you want to enable Dp on
> s/Dp/DP/
>
>> + RK3399 based SoC, you should selet this
> s/selet/select/
>
>> + 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..5b8a15e
>> --- /dev/null
>> +++ b/drivers/gpu/drm/rockchip/cdn-dp-core.c
>> @@ -0,0 +1,761 @@
>> +/*
>> + * 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>
>> +
>> +#include <sound/hdmi-codec.h>
>> +
>> +#include <video/of_videomode.h>
>> +#include <video/videomode.h>
> Doesn't seem like you use these.
>
>
>> +
>> +#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 DP_CLK_RATE 100000000
> If this clock rate never changes, it should probably live somewhere in
> the clock driver.
>
>> +#define WAIT_HPD_STABLE 300
> Encode the units in these two define names, ie: DP_CLK_RATE_HZ,
> WAIT_HPD_STABLE_MS
>
>> +
>> +static int cdn_dp_clk_enable(struct cdn_dp_device *dp)
>> +{
>> + int ret;
>> +
>> + 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;
>> + }
>> +
>> + ret = clk_set_rate(dp->core_clk, DP_CLK_RATE);
>> + if (ret < 0) {
>> + dev_err(dp->dev, "cannot set dp core clk to %d %d\n",
>> + DP_CLK_RATE, ret);
>> + goto err_set_rate;
>> + }
>> +
>> + /* notice fw the clk freq value */
> This might be clearer if it was rephrased to "update fw with the
> current core clk frequency". I still think the rate should be set in
> the clock driver, and perhaps you can query the rate to get the
> current value.
This function is setting the controller register, it let the uCPU know
what freq it is, then the uCPU use this value to do something.
>
>> + cdn_dp_set_fw_clk(dp, DP_CLK_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 ? connector_status_connected :
>> + connector_status_disconnected;
> If you just stored hpd_status as drm_connector_status, you could avoid
> having to translate the bool.
>
>> +}
>> +
>> +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;
>> +
>> + if (!dp->fw_loaded)
> Can this actually happen? Seems like we shouldn't be returning
> connected from detect if the fw isn't loaded, so this should never be
> true. If that is the case, I think BUG_ON or WARN_ON would be more
> appropriate here.
>
>
>> + return 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);
>> + drm_mode_connector_update_edid_property(connector, edid);
>> + drm_add_edid_modes(connector, edid);
>> + /* Store the ELD */
> This comment isn't useful
>
>> + drm_edid_to_eld(connector, edid);
>> + kfree(edid);
>> + } else {
>> + dev_dbg(dp->dev, "failed to get edid\n");
> This seems to warrant a stronger level than dbg, perhaps warn. Also,
> should this really return success?
>
>> + }
>> +
>> + return 0;
>> +}
>> +
>> +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 actual, rate;
>> +
>> + rate = drm_dp_bw_code_to_link_rate(dp->link.rate);
>> + actual = rate * dp->link.num_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;
>> + }
> This doesn't seem like something that is likely to happen given the
> trained rate should be a function of the display that's attached. Is
> that correct?
Yes, the link training should be a function of the display. But
sometimes the edid give
us a excess size for default resolution, it need somewhere to do this
mode valid checking.
Maybe we can do it at mode_set.
...
>
>> + hdr = (struct cdn_firmware_header *)fw->data;
>> + if (fw->size != le32_to_cpu(hdr->size_bytes))
>> + 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;
>> +
>> + release_firmware(fw);
> Move this out of here and into the same scope as request_firmware so
> there are no leaks.
>
>> +
>> + ret = cdn_dp_active(dp, true);
>> + if (ret) {
>> + dev_err(dp->dev, "active ucpu failed: %d\n", ret);
>> + return ret;
>> + }
>> +
>> + 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);
>> + }
>> +
>> + dp->irq = platform_get_irq(pdev, 0);
>> + if (dp->irq < 0) {
>> + dev_err(dev, "cdn-dp can not get irq\n");
>> + return dp->irq;
>> + }
>> +
>> + 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;
>> +
>> + dp_clock_reset_seq(dp);
>> +
>> + return 0;
>> +}
>> +
>> +static int cdn_dp_audio_hw_params(struct device *dev,
>> + 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)
>> +{
>> + 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, 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, uint8_t *buf, size_t len)
>> +{
>> + 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 void cdn_dp_get_state(struct cdn_dp_device *dp, struct extcon_dev *edev)
>> +{
>> + bool dfp, dptx;
>> + u8 cap_lanes;
>> +
>> + dfp = extcon_get_cable_state_(edev, EXTCON_USB_HOST);
>> + dptx = extcon_get_cable_state_(edev, EXTCON_DISP_DP);
>> +
>> + if (dfp && dptx)
>> + cap_lanes = 2;
>> + else if (dptx)
>> + cap_lanes = 4;
>> + else
>> + cap_lanes = 0;
>> +
>> + if (cap_lanes != dp->cap_lanes) {
>> + dp->cap_lanes = cap_lanes;
>> + schedule_delayed_work(&dp->event_wq, 0);
>> + }
> A get function shouldn't be scheduling work. Keep the assignment here
> and move the schedule into the pd_event function.
>
>> +}
>> +
>> +static int cdn_dp_pd_event(struct notifier_block *nb,
>> + unsigned long event, void *priv)
>> +{
>> + struct cdn_dp_device *dp;
>> + struct extcon_dev *edev = priv;
>> + u8 i;
>> +
>> + dp = container_of(nb, struct cdn_dp_device, event_nb);
>> +
>> + for (i = 0; i < MAX_PHY; i++) {
>> + if (edev == dp->extcon[i]) {
>> + dp->port_id = i;
>> + break;
>> + }
>> + }
>> +
>> + cdn_dp_get_state(dp, edev);
> There's a race here. If the cap_lanes change in between scheduling the
> work and the work function running (ie, plug/unplug), the work
> function will have out-of-date information. You should call this from
> the work function instead.
>
>
>> +
>> + return 0;
>> +}
>> +
>> +static void cdn_dp_pd_event_wq(struct work_struct *work)
>> +{
>> + struct cdn_dp_device *dp;
>> + int ret;
>> +
>> + dp = container_of(work, struct cdn_dp_device, event_wq.work);
>> +
>> + ret = request_firmware(&dp->fw, "cdn/dptx.bin", dp->dev);
> This filename needs to be abstracted into a #define.
>
> You're also failing to call release_firmware in a bunch of cases
> below. It needs to be sorted out.
>
>
>> + if (ret == -ENOENT && !dp->fw_loaded) {
> So the case where ret == -ENOENT and dp->fw_loaded is valid? Or is that a bug?
>
> I'm not convinced you need fw_loaded stored in cdn_dp_device. It seems
> like something you could either get rid of (hopefully), or convert to
> a local.
it is not bug, "ret == -ENOENT" is for file missing, maybe user space is
not ready.
if dp->fw_loaded it means the firmware has been loaded, do not load again.
>
>> + /*
>> + * If can not find the file, retry to load the firmware in 1
>> + * second, if still failed after 1 minute, give up.
>> + */
>> + if (dp->fw_retry++ < 60) {
>> + schedule_delayed_work(&dp->event_wq,
>> + msecs_to_jiffies(HZ));
> I'd rather do this as an exponential back-off so if it doesn't find
> the file, it waits progressively longer.
>
> Perhaps something like:
>
> #define MAX_FW_WAIT_SECS 64
>
> [...]
>
> if (dp->fw_wait <= MAX_FW_WAIT_SECS) {
> schedule_delayed_work(&dp_>event_wq, msecs_to_jiffies(dp->fw_wait * HZ));
> dp->fw_wait *= 2;
> }
If so, sometimes boot with DP will later than boot and then plug DP cable.
>> + }
>> +
>> + dev_err(dp->dev, "failed to request firmware %d\n", ret);
> Print the wait/retries.
>
>> + return;
>> + }
>> +
>> + if (!dp->cap_lanes) {
>> + if (dp->phy_status[dp->port_id])
>> + phy_power_off(dp->phy[dp->port_id]);
>> + dp->phy_status[dp->port_id] = 0;
>> + dp->hpd_status = false;
>> + drm_helper_hpd_irq_event(dp->drm_dev);
>> + return;
>> + }
>> +
>> + if (!dp->phy_status[dp->port_id]) {
>> + ret = phy_power_on(dp->phy[dp->port_id]);
>> + if (ret)
> Log something in this case
>
>> + return;
>> +
>> + msleep(WAIT_HPD_STABLE);
> 300ms is a long time, do we really need to wait that long?
The 300ms is a safe value, maybe this time can be reduced
>
>> + }
>> +
>> + dp->phy_status[dp->port_id] = 1;
> Do you really need phy_status? It seems like if things are
> well-behaved you shouldn't need it. Of course, if you're turning
> on/off multiple times, perhaps there's a bug elsewhere.
This status is needed, since the phy_power_on would increase the
power_count, this status can avoid power on multiple times
>
>> +
>> + ret = cdn_dp_firmware_init(dp);
>> + if (ret)
>> + return;
>> +
>> + /* read hpd status failed, or the hpd does not exist. */
>> + ret = cdn_dp_get_hpd_status(dp);
>> + if (ret <= 0)
> Log something?
>
>> + return;
>> +
>> + /*
>> + * Set the capability and start the training process once
>> + * the hpd is detected.
>> + */
>> + ret = cdn_dp_set_host_cap(dp);
>> + if (ret) {
>> + dev_err(dp->dev, "set host capabilities failed\n");
> print ret
>
>> + return;
>> + }
>> +
>> + ret = cdn_dp_training_start(dp);
>> + if (ret) {
>> + dev_err(dp->dev, "hw lt err:%d\n", ret);
> s/lt/link training/
>
>> + return;
>> + }
>> +
>> + ret = cdn_dp_get_lt_status(dp);
> Change to cdn_dp_get_training_status
>
>> + if (ret) {
>> + dev_err(dp->dev, "hw lt get status failed\n");
> print ret
>
>> + return;
>> + }
>> +
>> + dev_info(dp->dev, "rate:%d, lanes:%d\n",
>> + dp->link.rate, dp->link.num_lanes);
>> +
> I think everything from cdn_dp_firmare_init to here should be moved
> out of the wq and deferred until modeset time. That way you're
> training the link at the same time as you're setting the mode, which
> should obviate the need to check the clocks in mode_valid.
cdn_dp_training_start and cdn_dp_get_lt_status can be move the mode_set,
but the others are need by get_modes, so stay here is better.
>
>> + dp->hpd_status = true;
>> + drm_helper_hpd_irq_event(dp->drm_dev);
>> +}
>> +
>> +static int cdn_dp_bind(struct device *dev, struct device *master,
>> + void *data)
>> +{
>> + struct cdn_dp_device *dp = dev_get_drvdata(dev);
>> + struct drm_encoder *encoder;
>> + struct drm_connector *connector;
>> + struct drm_device *drm_dev = data;
>> + int ret, i;
>> +
>> + ret = cdn_dp_init(dp);
>> + if (ret < 0)
>> + return ret;
>> +
>> + dp->drm_dev = drm_dev;
>> +
>> + 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);
>> +
>> + dp->event_nb.notifier_call = cdn_dp_pd_event;
>> + INIT_DELAYED_WORK(&dp->event_wq, cdn_dp_pd_event_wq);
>> +
>> + for (i = 0; i < MAX_PHY; i++) {
>> + if (IS_ERR(dp->extcon[i]))
>> + continue;
>> +
>> + ret = extcon_register_notifier(dp->extcon[i], EXTCON_DISP_DP,
>> + &dp->event_nb);
>> + if (ret) {
>> + dev_err(dev, "regitster EXTCON_DISP_DP notifier err\n");
>> + return ret;
>> + }
>> +
>> + cdn_dp_get_state(dp, dp->extcon[i]);
>> + }
>> +
>> + 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;
>> + int i;
>> +
>> + platform_device_unregister(dp->audio_pdev);
>> + cdn_dp_encoder_disable(encoder);
>> + encoder->funcs->destroy(encoder);
>> + drm_connector_unregister(&dp->connector);
>> + drm_connector_cleanup(&dp->connector);
> just call connector->destroy() here
>
>> + drm_encoder_cleanup(encoder);
> this is already called by encoder->destroy()
>
>> +
>> + for (i = 0; i < MAX_PHY; i++) {
>> + if (!IS_ERR(dp->extcon[i]))
>> + extcon_unregister_notifier(dp->extcon[i], EXTCON_USB,
>> + &dp->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;
>> + struct cdn_dp_device *dp;
>> + u8 count = 0;
>> + int i;
>> +
>> + dp = devm_kzalloc(dev, sizeof(*dp), GFP_KERNEL);
>> + if (!dp)
>> + return -ENOMEM;
>> + dp->dev = dev;
>> +
>> + for (i = 0; i < MAX_PHY; i++) {
>> + dp->extcon[i] = extcon_get_edev_by_phandle(dev, i);
>> + dp->phy[i] = devm_of_phy_get_by_index(dev, dev->of_node, i);
>> +
>> + if (!IS_ERR(dp->extcon[i]) && !IS_ERR(dp->phy[i]))
>> + count++;
>> +
>> + if (PTR_ERR(dp->extcon[i]) == -EPROBE_DEFER ||
>> + PTR_ERR(dp->phy[i]) == -EPROBE_DEFER)
>> + return -EPROBE_DEFER;
>> + }
>> +
>> + if (!count) {
>> + 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 const struct of_device_id cdn_dp_dt_ids[] = {
>> + { .compatible = "rockchip,rk3399-cdn-dp" },
>> + {}
>> +};
>> +
>> +MODULE_DEVICE_TABLE(of, cdn_dp_dt_ids);
>> +
>> +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..31ba22d
>> --- /dev/null
>> +++ b/drivers/gpu/drm/rockchip/cdn-dp-core.h
>> @@ -0,0 +1,113 @@
>> +/*
>> + * 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 _ROCKCHIP_EDP_CORE_H
>> +#define _ROCKCHIP_EDP_CORE_H
> I think the include guard should match the filename
>
>> +
>> +#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"
>> +#include "cdn-dp-reg.h"
>> +
>> +#define MAX_PHY 2
> This should probably be stored in the .data member of of_device_id.
>
>> +
>> +enum AUDIO_FORMAT {
> 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;
>> +};
>> +
>> +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_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_retry;
>> + bool fw_loaded;
>> + void __iomem *regs;
>> + struct regmap *grf;
>> + unsigned int irq;
>> + 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 extcon_dev *extcon[MAX_PHY];
>> + struct phy *phy[MAX_PHY];
>> + struct notifier_block event_nb;
>> + struct delayed_work event_wq;
>> +
>> + u8 port_id;
>> + u8 cap_lanes;
>> + bool hpd_status;
>> + bool phy_status[MAX_PHY];
>> +
>> + int dpms_mode;
>> + struct drm_dp_link link;
>> + bool sink_has_audio;
>> +};
>> +
>> +void dp_clock_reset_seq(struct cdn_dp_device *dp);
> cdn_ prefix here?
>
>> +
>> +void cdn_dp_set_fw_clk(struct cdn_dp_device *dp, int 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);
>> +int cdn_dp_event_config(struct cdn_dp_device *dp);
>> +int 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);
>> +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_lt_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);
>> +
> I really don't like that you've declared these in core.h, yet defined
> them in reg.c.
>
>> +#endif /* _ROCKCHIP_EDP_CORE_H */
> Make sure you update here too
>
>
>> 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..8d5becd
>> --- /dev/null
>> +++ b/drivers/gpu/drm/rockchip/cdn-dp-reg.c
>> @@ -0,0 +1,740 @@
>> +/*
>> + * 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_TIMEOUT_US 5000000
>> +
>> +void cdn_dp_set_fw_clk(struct cdn_dp_device *dp, int clk)
>> +{
>> + writel(clk / 1000000, dp->regs + SW_CLK_H);
>> +}
>> +
>> +void dp_clock_reset_seq(struct cdn_dp_device *dp)
>> +{
>> + writel(0xfff, dp->regs + SOURCE_DPTX_CAR);
>> + writel(0x7, dp->regs + SOURCE_PHY_CAR);
>> + writel(0xf, dp->regs + SOURCE_PKT_CAR);
>> + writel(0xff, dp->regs + SOURCE_AIF_CAR);
>> + writel(0xf, dp->regs + SOURCE_CIPHER_CAR);
>> + writel(0x3, dp->regs + SOURCE_CRYPTO_CAR);
>> + writel(0, dp->regs + APB_INT_MASK);
> Pull these hardcoded values out into #defines
>
>> +}
>> +
>> +static int cdn_dp_mailbox_read(struct cdn_dp_device *dp)
>> +{
>> + int val, ret;
>> +
>> + if (!dp->fw_loaded)
>> + return 0;
> This seems like an error. Return -errno and log a message
The audio will call this function before firmware during probe, return
err cause audio register failed.
>
>> +
>> + ret = readx_poll_timeout(readl, dp->regs + MAILBOX_EMPTY_ADDR,
>> + val, !val, 1000, MAILBOX_TIMEOUT_US);
> Pull the 1000 out into a #define (here and below)
>
>> + 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)
>> +{
>> + int ret, full;
>> +
>> + if (!dp->fw_loaded)
>> + return 0;
> Same here
>
>> +
>> + ret = readx_poll_timeout(readl, dp->regs + MAILBOX_FULL_ADDR,
>> + full, !full, 1000, 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_response(struct cdn_dp_device *dp, u8 module_id,
> I think _receive would be a better name than _response
>
>> + u8 opcode, u8 *buff, u8 buff_size)
>> +{
>> + int ret, i = 0;
>> + u8 header[4];
>> +
>> + /* read the header of the message */
>> + while (i < 4) {
> for (i = 0; i < 4; i++) {
>
>> + ret = cdn_dp_mailbox_read(dp);
>> + if (ret < 0)
>> + return ret;
>> +
>> + header[i++] = ret;
> header[i] = ret;
>
>> + }
>> +
>> + if (opcode != header[0] || module_id != header[1] ||
>> + buff_size != ((header[2] << 8) | header[3])) {
> pull header[2] << 8 | header[3] out into a local, mbox_size.
>
>> + dev_err(dp->dev, "mailbox response failed");
>> +
>> + /*
>> + * If the message in mailbox is not what we want, we need to
>> + * clear the mailbox by read.
>> + */
>> + i = (header[2] << 8) | header[3];
>> + while (i--)
> for (i = 0; i < mbox_size; i++)
>
>> + if (cdn_dp_mailbox_read(dp) < 0)
>> + break;
>> +
>> + return -EINVAL;
>> + }
>> +
>> + i = 0;
>> + while (i < buff_size) {
> for (i = 0; i < buff_size; i++) {
>
>> + ret = cdn_dp_mailbox_read(dp);
>> + if (ret < 0)
>> + return ret;
>> +
>> + buff[i++] = ret;
> buff[i] = ret;
>
>> + }
>> +
>> + return 0;
>
> Are you always guaranteed to have the entire message in the mailbox?
> If not, you might consider supporting partial messages and returning
> the length read.
>
>> +}
>> +
>> +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;
> (size >> 8) & 0xff;
>
>> + header[3] = size & 0xff;
>> +
>> + for (i = 0; i < 4; i++) {
>> + ret = cdp_dp_mailbox_write(dp, header[i]);
>> + if (ret)
>> + return ret;
>> + }
>> +
>> + while (size--) {
> for (i = 0; i < size; i++) {
>
>> + ret = cdp_dp_mailbox_write(dp, *message++);
> message[i]
>
>> + if (ret)
> Log something here?
>
>> + return ret;
>> + }
>> +
>> + return 0;
> Perhaps consider returning the number of bytes that were sent.
>
>> +}
>> +
>> +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,
>> + ARRAY_SIZE(msg), msg);
>> +}
>> +
>> +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, reg, ret;
> reg should be u32
>
>> +
>> + /* 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;
>> +
> Are there any sanity checks you can do on the fw_version before returning?
This is first version of firmware, so do not nedd check the number, But
I think adding a dev_dbg log here is better.
>
>> + dp->fw_loaded = 1;
>> +
>> + 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_active(struct cdn_dp_device *dp, bool enable)
>> +{
>> + u8 active = enable ? 1 : 0;
>> + u8 resp;
>> + int ret;
>> +
>> + /* set firmware status, 1: avtive; 0: standby */
> s/avtive/active/
>
>> + ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_GENERAL,
>> + GENERAL_MAIN_CONTROL, 1, &active);
>> + if (ret)
>> + return ret;
>> +
>> + ret = cdn_dp_mailbox_response(dp, MB_MODULE_ID_GENERAL,
>> + GENERAL_MAIN_CONTROL, &resp, 1);
>> + if (ret)
>> + return ret;
>> +
>> + return resp ? 0 : -EINVAL;
>> +}
>> +
>> +int cdn_dp_set_host_cap(struct cdn_dp_device *dp)
>> +{
>> + u8 msg[8];
>> + int ret;
>> +
>> + msg[0] = DP_LINK_BW_5_4;
> Why is this always 5.4GHz? Does the hw support any other rates?
It is setting the max rate to 5.4G, not all support rate.
>
>> + msg[1] = dp->cap_lanes;
>> + msg[2] = VOLTAGE_LEVEL_2;
>> + msg[3] = PRE_EMPHASIS_LEVEL_3;
>> + msg[4] = PRBS7 | D10_2 | TRAINING_PTN1 | TRAINING_PTN2;
> You don't need to use training pattern 3 for hbr modes?
This is the fault of pattern name, it should be:
msg[4] = TPS1 | TPS2 | TPS3 | TPS4;
>
>> + 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,
>> + ARRAY_SIZE(msg), msg);
> ARRAY_SIZE counts the number of elements, not the size, so I think
> you're better off using sizeof instead. This applies to the rest of
> the dp_mailbox_send instances as well.
>
>> + 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] = {0, 0, 0, 0, 0};
> 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,
>> + ARRAY_SIZE(msg), msg);
>> +}
>> +
>> +int cdn_dp_get_event(struct cdn_dp_device *dp)
> Should return u32
>
>> +{
>> + 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_response(dp, MB_MODULE_ID_DP_TX,
>> + DPTX_HPD_STATE, &status, 1);
>> + 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[EDID_DATA + EDID_BLOCK_SIZE];
>> + int ret;
>> +
>> + if (length != EDID_BLOCK_SIZE)
>> + return -EINVAL;
>> +
>> + msg[0] = block / 2;
>> + msg[1] = block % 2;
>> +
>> + ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_GET_EDID,
>> + 2, msg);
> sizeof(msg), msg);
>
>> + if (ret)
>> + return ret;
>> +
>> + ret = cdn_dp_mailbox_response(dp, MB_MODULE_ID_DP_TX,
>> + DPTX_GET_EDID, reg,
>> + EDID_DATA + EDID_BLOCK_SIZE);
>> + if (ret)
>> + return ret;
>> +
>> + if (reg[EDID_LENGTH_BYTE] != EDID_BLOCK_SIZE ||
>> + reg[EDID_SEGMENT_BUMBER] != block / 2) {
>> + dev_err(dp->dev, "edid block size err\n");
>> + return -EINVAL;
>> + }
>> +
>> + memcpy(edid, ®[EDID_DATA], EDID_BLOCK_SIZE);
> You can avoid the intermediate reg[] buffer if you restructure the
> _response/_receive mailbox function. I'd suggest splitting it into a
> _validate_response() function that reads the header and makes sure the
> lengths match. The second part would be a _read_response() which
> simply reads the specified number of bytes from the mailbox. For
> convenience, you could make cdn_dp_mailbox_receive() a helper which
> calls both validate and read for times when you're reading the same
> number as you're validating.
>
> So in this function, you'd validate the response has EDID_DATA +
> EDID_BLOCK_SIZE bytes, then read the EDID_DATA prefix into a local,
> then read EDID_BLOCK_DATA directly into edid.
>
> I think you'll also need a _drain function to clear out the mailbox in
> case of error (otherwise the next read will fail).
>
>> +
>> + 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,
>> + 1, &msg);
>> + if (ret)
>> + return ret;
>> +
>> + /* the whole training should finish in 500ms */
>> + timeout = jiffies + msecs_to_jiffies(500);
> Pull 500 out into a #define
>
>> + while (1) {
> while(time_before(jiffies, timeout))
>
>> + msleep(20);
> Pull 20 out into a #define
>
>> + ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX,
>> + DPTX_READ_EVENT, 0, NULL);
>> + if (ret)
>> + return ret;
>> +
>> + ret = cdn_dp_mailbox_response(dp, MB_MODULE_ID_DP_TX,
>> + DPTX_READ_EVENT, event, 2);
>> + if (ret)
>> + return ret;
>> +
>> + if (event[1] & EQ_PHASE_FINISHED)
>> + break;
> return 0
>
>> +
>> + if (time_after(jiffies, timeout))
>> + return -ETIMEDOUT;
>> + }
>> +
>> + return 0;
> return -ETIMEDOUT
>
>> +}
>> +
>> +int cdn_dp_get_lt_status(struct cdn_dp_device *dp)
> s/lt/training/
>
>> +{
>> + 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_response(dp, MB_MODULE_ID_DP_TX,
>> + DPTX_READ_LINK_STAT, status, 10);
> s/10/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,
>> + 1, &msg);
> s/1/sizeof(msg)/
>
>> +}
>> +
>> +static int cdn_dp_get_msa_misc(struct video_info *video,
>> + struct drm_display_mode *mode)
>> +{
>> + u8 val0, val1;
> u8 val[2];
>
>> + u32 msa_misc;
>> +
>> + switch (video->color_fmt) {
>> + case PXL_RGB:
>> + case Y_ONLY:
>> + val0 = 0;
>> + break;
> Perhaps this would be better as listed under the default case.
>
>> + case YCBCR_4_4_4:
>> + /* set default color space conversion to BT601 */
>> + val0 = 6 + BT_601 * 8;
>> + break;
>> + case YCBCR_4_2_2:
>> + /* set default color space conversion to BT601 */
>> + val0 = 5 + BT_601 * 8;
>> + break;
>> + case YCBCR_4_2_0:
>> + val0 = 5;
>> + break;
>> + };
>> +
>> + switch (video->color_depth) {
>> + case 6:
>> + val1 = 0;
>> + break;
>> + case 8:
>> + val1 = 1;
>> + break;
>> + case 10:
>> + val1 = 2;
>> + break;
>> + case 12:
>> + val1 = 3;
>> + break;
>> + case 16:
>> + val1 = 4;
>> + break;
>> + };
>> +
>> + msa_misc = 2 * val0 + 32 * val1 +
>> + ((video->color_fmt == Y_ONLY) ? (1 << 14) : 0);
> Perhaps a stupid question, but is this documented anywhere? If not,
> could you add a comment describing what you're doing?
>
>> +
>> + 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;
>> + 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);
>> +
>> + val = VIF_BYPASS_INTERLACE;
>> +
> remove extra line
>
>> + 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 symbol */
>> + do {
>> + tu_size_reg += 2;
>> + symbol = tu_size_reg * mode->clock * bit_per_pix;
>> + symbol /= dp->link.num_lanes * link_rate * 8;
>> + } while ((symbol == 1) || (tu_size_reg - symbol < 4));
>> +
>> + val = symbol + (tu_size_reg << 8);
>> +
> remove extra line
>
>> + ret = cdn_dp_reg_write(dp, DP_FRAMER_TU, val);
>> + if (ret)
>> + return ret;
>> +
>> + 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);
>> +
> remove extra line
>
>> + 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;
>> + val |= (video->v_sync_polarity << 15);
> Make this consistent with how you assigned val for MSA_HORIZONTAL_1
> (ie: split both or combine both)
>
>> + 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;
>> +
> extra line
>
>> + 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)
>> +{
>> + int ret = cdn_dp_reg_write(dp, AUDIO_PACK_CONTROL, AUDIO_PACK_EN(0));
>> +
> remove this empty line
>
>> + if (ret)
>> + return ret;
> insert empy line
>
>> + writel(0x1F0707, dp->regs + SPDIF_CTRL_ADDR);
> pull this magic value into a #define
>
>> + writel(0, dp->regs + AUDIO_SRC_CNTL);
>> + writel(0, dp->regs + AUDIO_SRC_CNFG);
>> + writel(1, dp->regs + AUDIO_SRC_CNTL);
>> + writel(0, dp->regs + AUDIO_SRC_CNTL);
>> +
>> + writel(0, dp->regs + SMPL2PKT_CNTL);
>> + writel(1, dp->regs + SMPL2PKT_CNTL);
>> + writel(0, dp->regs + SMPL2PKT_CNTL);
>> +
>> + writel(1, dp->regs + FIFO_CNTL);
>> + writel(0, dp->regs + FIFO_CNTL);
> Can you document why you need to toggle these bits as opposed to just
> setting them to 0?
>
>> +
>> + 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);
>> +}
>> +
>> +int cdn_dp_audio_config_set(struct cdn_dp_device *dp, struct audio_info *audio)
>> +{
>> + int lanes_param, i2s_port_en_val, val, i;
> int lanes_param = 3, i2s_port_en_val = 0xf, i;
>
>> + int ret;
>> +
>> + if (audio->channels == 2 && dp->link.num_lanes == 1)
>> + lanes_param = 1;
>> + else if (audio->channels == 2)
>> + lanes_param = 3;
>> + else
>> + lanes_param = 0;
>> +
>> + if (audio->channels == 2)
>> + i2s_port_en_val = 1;
>> + else if (audio->channels == 4)
>> + i2s_port_en_val = 3;
>> + else
>> + i2s_port_en_val = 0xf;
>
> I think with the above initialization values, you can replace these 2
> conditionals with:
>
> if (audio->channels == 2) {
> if (dp->link.num_lanes == 1)
> lanes_param = 3;
> i2s_port_en_val = 1;
> } else if (audio->channels == 4) {
> i2s_port_en_val = 3;
> }
>
>
>> +
>> + 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, 0x8000);
> pull value out into #define (and use BIT(15) if appropriate)
>
>> + if (ret)
>> + return ret;
>> +
>> + ret = cdn_dp_reg_write(dp, CM_CTRL, 0);
>> + if (ret)
>> + return ret;
>> +
>> + if (audio->format == AFMT_I2S) {
>> + writel(0x0, dp->regs + SPDIF_CTRL_ADDR);
>> +
>> + writel(SYNC_WR_TO_CH_ZERO, dp->regs + FIFO_CNTL);
>> +
>> + val = audio->channels - 1;
>> + val |= (audio->channels / 2 - 1) << 5;
>> + val |= BIT(8);
>> + val |= lanes_param << 11;
>> + 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->channels - 1) << 2;
>> + val |= i2s_port_en_val << 17;
>> + val |= 2 << 11;
>> + 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(2, dp->regs + SMPL2PKT_CNTL);
>> + writel(2, dp->regs + AUDIO_SRC_CNTL);
> Pull all of this code into a new cdn_dp_audio_config_i2s() function
> (with the lane_param and i2s_port_en_val assignments) and call it from
> here
>
>> + } else {
>> + val = 0x1F0707;
> Magic values need to be in #defines
>
>> + writel(val, dp->regs + SPDIF_CTRL_ADDR);
>> +
>> + writel(SYNC_WR_TO_CH_ZERO, dp->regs + FIFO_CNTL);
>> +
>> + val = 0x101 | (3 << 11);
> Same here, these mean nothing.
>
>> + writel(val, dp->regs + SMPL2PKT_CNFG);
>> + writel(2, dp->regs + SMPL2PKT_CNTL);
>> +
>> + val = 0x3F0707;
> And here. And anywhere else I missed.
>
>> + writel(val, dp->regs + SPDIF_CTRL_ADDR);
>> +
>> + clk_prepare_enable(dp->spdif_clk);
>> + clk_set_rate(dp->spdif_clk, CDN_DP_SPDIF_CLK);
>> + }
>> +
>> + return cdn_dp_reg_write(dp, AUDIO_PACK_CONTROL, AUDIO_PACK_EN(1));
>> +}
>> 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..b33793e
>> --- /dev/null
>> +++ b/drivers/gpu/drm/rockchip/cdn-dp-reg.h
>> @@ -0,0 +1,409 @@
>> +/*
>> + * 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
> Can you split these up into individual bits?
>
>> +#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
> These cntl and cnfig values should be split up so we know what the
> individual bits do
>
>> +
>> +/* 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
> Same here, split these up! Everywhere else applicable too.
>
>> +#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 APB_IRAM_PATH BIT(2)
>> +#define APB_DRAM_PATH BIT(1)
>> +#define APB_XT_RESET BIT(0)
>> +
>> +/* 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 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 EDID_LENGTH_BYTE 0
>> +#define EDID_SEGMENT_BUMBER 1
>> +#define EDID_DATA 2
>> +#define EDID_BLOCK_SIZE 128
>> +
>> +#define TU_SIZE 30
>> +
>> +/* audio */
>> +#define AUDIO_PACK_EN(x) ((x) << 8)
>> +#define SAMPLING_FREQ(x) ((x) << 16)
>> +#define ORIGINAL_SAMP_FREQ(x) ((x) << 24)
>> +#define SYNC_WR_TO_CH_ZERO BIT(1)
>> +
>> +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 {
>> + PRBS7 = BIT(0),
>> + D10_2 = BIT(1),
>> + TRAINING_PTN1 = BIT(2),
>> + TRAINING_PTN2 = BIT(3),
>> + DP_NONE = BIT(4)
>> +};
>> +
>> +enum VIC_PXL_ENCODING_FORMAT {
> lowercase name
>
>> + PXL_RGB = 0x1,
>> + YCBCR_4_4_4 = 0x2,
>> + YCBCR_4_2_2 = 0x4,
>> + YCBCR_4_2_0 = 0x8,
>> + Y_ONLY = 0x10,
>> +};
>> +
>> +enum VIC_COLOR_DEPTH {
> and here
>
>> + BCS_6 = 0x1,
>> + BCS_8 = 0x2,
>> + BCS_10 = 0x4,
>> + BCS_12 = 0x8,
>> + BCS_16 = 0x10,
>> +};
>> +
>> +enum VIC_BT_TYPE {
> and here
>
>> + BT_601 = 0x0,
>> + BT_709 = 0x1,
>> +};
>> +
>> +#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..98302b3 100644
>> --- a/drivers/gpu/drm/rockchip/rockchip_drm_vop.c
>> +++ b/drivers/gpu/drm/rockchip/rockchip_drm_vop.c
>> @@ -969,7 +969,7 @@ static void vop_crtc_enable(struct drm_crtc *crtc)
>> vop_dsp_hold_valid_irq_disable(vop);
>> }
>>
>> - pin_pol = 0x8;
>> + pin_pol = (s->output_type == DRM_MODE_CONNECTOR_DisplayPort) ? 0 : 0x8;
> There's no sense checking output_type here and then again in the
> switch statement. Instead, pull 0x8 into a #define and only assign it
> to pin_pol in the individual case statements below.
>
>> pin_pol |= (adjusted_mode->flags & DRM_MODE_FLAG_NHSYNC) ? 0 : 1;
>> pin_pol |= (adjusted_mode->flags & DRM_MODE_FLAG_NVSYNC) ? 0 : (1 << 1);
>> VOP_CTRL_SET(vop, pin_pol, pin_pol);
>> @@ -991,6 +991,10 @@ 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:
>> + 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..50a045c 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;
>> 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
>>
>> _______________________________________________
>> dri-devel mailing list
>> dri-devel at lists.freedesktop.org
>> https://lists.freedesktop.org/mailman/listinfo/dri-devel
>
>
More information about the Linux-rockchip
mailing list