Lines Matching +full:dp +full:- +full:connector
1 // SPDX-License-Identifier: GPL-2.0-only
4 * Author: Chris Zhong <zyw@rock-chips.com>
16 #include <sound/hdmi-codec.h>
25 #include "cdn-dp-core.h"
26 #include "cdn-dp-reg.h"
28 static inline struct cdn_dp_device *connector_to_dp(struct drm_connector *connector) in connector_to_dp() argument
30 return container_of(connector, struct cdn_dp_device, connector); in connector_to_dp()
61 { .compatible = "rockchip,rk3399-cdn-dp",
68 static int cdn_dp_grf_write(struct cdn_dp_device *dp, in cdn_dp_grf_write() argument
73 ret = clk_prepare_enable(dp->grf_clk); in cdn_dp_grf_write()
75 DRM_DEV_ERROR(dp->dev, "Failed to prepare_enable grf clock\n"); in cdn_dp_grf_write()
79 ret = regmap_write(dp->grf, reg, val); in cdn_dp_grf_write()
81 DRM_DEV_ERROR(dp->dev, "Could not write to GRF: %d\n", ret); in cdn_dp_grf_write()
82 clk_disable_unprepare(dp->grf_clk); in cdn_dp_grf_write()
86 clk_disable_unprepare(dp->grf_clk); in cdn_dp_grf_write()
91 static int cdn_dp_clk_enable(struct cdn_dp_device *dp) in cdn_dp_clk_enable() argument
96 ret = clk_prepare_enable(dp->pclk); in cdn_dp_clk_enable()
98 DRM_DEV_ERROR(dp->dev, "cannot enable dp pclk %d\n", ret); in cdn_dp_clk_enable()
102 ret = clk_prepare_enable(dp->core_clk); in cdn_dp_clk_enable()
104 DRM_DEV_ERROR(dp->dev, "cannot enable core_clk %d\n", ret); in cdn_dp_clk_enable()
108 ret = pm_runtime_get_sync(dp->dev); in cdn_dp_clk_enable()
110 DRM_DEV_ERROR(dp->dev, "cannot get pm runtime %d\n", ret); in cdn_dp_clk_enable()
114 reset_control_assert(dp->core_rst); in cdn_dp_clk_enable()
115 reset_control_assert(dp->dptx_rst); in cdn_dp_clk_enable()
116 reset_control_assert(dp->apb_rst); in cdn_dp_clk_enable()
117 reset_control_deassert(dp->core_rst); in cdn_dp_clk_enable()
118 reset_control_deassert(dp->dptx_rst); in cdn_dp_clk_enable()
119 reset_control_deassert(dp->apb_rst); in cdn_dp_clk_enable()
121 rate = clk_get_rate(dp->core_clk); in cdn_dp_clk_enable()
123 DRM_DEV_ERROR(dp->dev, "get clk rate failed\n"); in cdn_dp_clk_enable()
124 ret = -EINVAL; in cdn_dp_clk_enable()
128 cdn_dp_set_fw_clk(dp, rate); in cdn_dp_clk_enable()
129 cdn_dp_clock_reset(dp); in cdn_dp_clk_enable()
134 pm_runtime_put(dp->dev); in cdn_dp_clk_enable()
136 clk_disable_unprepare(dp->core_clk); in cdn_dp_clk_enable()
138 clk_disable_unprepare(dp->pclk); in cdn_dp_clk_enable()
143 static void cdn_dp_clk_disable(struct cdn_dp_device *dp) in cdn_dp_clk_disable() argument
145 pm_runtime_put_sync(dp->dev); in cdn_dp_clk_disable()
146 clk_disable_unprepare(dp->pclk); in cdn_dp_clk_disable()
147 clk_disable_unprepare(dp->core_clk); in cdn_dp_clk_disable()
152 struct extcon_dev *edev = port->extcon; in cdn_dp_get_port_lanes()
172 static int cdn_dp_get_sink_count(struct cdn_dp_device *dp, u8 *sink_count) in cdn_dp_get_sink_count() argument
178 ret = cdn_dp_dpcd_read(dp, DP_SINK_COUNT, &value, 1); in cdn_dp_get_sink_count()
186 static struct cdn_dp_port *cdn_dp_connected_port(struct cdn_dp_device *dp) in cdn_dp_connected_port() argument
191 for (i = 0; i < dp->ports; i++) { in cdn_dp_connected_port()
192 port = dp->port[i]; in cdn_dp_connected_port()
200 static bool cdn_dp_check_sink_connection(struct cdn_dp_device *dp) in cdn_dp_check_sink_connection() argument
206 if (dp->active_port < 0 || dp->active_port >= dp->ports) { in cdn_dp_check_sink_connection()
207 DRM_DEV_ERROR(dp->dev, "active_port is wrong!\n"); in cdn_dp_check_sink_connection()
211 port = dp->port[dp->active_port]; in cdn_dp_check_sink_connection()
220 if (!extcon_get_state(port->extcon, EXTCON_DISP_DP)) in cdn_dp_check_sink_connection()
223 if (!cdn_dp_get_sink_count(dp, &sink_count)) in cdn_dp_check_sink_connection()
229 DRM_DEV_ERROR(dp->dev, "Get sink capability timed out\n"); in cdn_dp_check_sink_connection()
234 cdn_dp_connector_detect(struct drm_connector *connector, bool force) in cdn_dp_connector_detect() argument
236 struct cdn_dp_device *dp = connector_to_dp(connector); in cdn_dp_connector_detect() local
239 mutex_lock(&dp->lock); in cdn_dp_connector_detect()
240 if (dp->connected) in cdn_dp_connector_detect()
242 mutex_unlock(&dp->lock); in cdn_dp_connector_detect()
247 static void cdn_dp_connector_destroy(struct drm_connector *connector) in cdn_dp_connector_destroy() argument
249 drm_connector_unregister(connector); in cdn_dp_connector_destroy()
250 drm_connector_cleanup(connector); in cdn_dp_connector_destroy()
262 static int cdn_dp_connector_get_modes(struct drm_connector *connector) in cdn_dp_connector_get_modes() argument
264 struct cdn_dp_device *dp = connector_to_dp(connector); in cdn_dp_connector_get_modes() local
268 mutex_lock(&dp->lock); in cdn_dp_connector_get_modes()
269 edid = dp->edid; in cdn_dp_connector_get_modes()
271 DRM_DEV_DEBUG_KMS(dp->dev, "got edid: width[%d] x height[%d]\n", in cdn_dp_connector_get_modes()
272 edid->width_cm, edid->height_cm); in cdn_dp_connector_get_modes()
274 dp->sink_has_audio = drm_detect_monitor_audio(edid); in cdn_dp_connector_get_modes()
276 drm_connector_update_edid_property(connector, edid); in cdn_dp_connector_get_modes()
277 ret = drm_add_edid_modes(connector, edid); in cdn_dp_connector_get_modes()
279 mutex_unlock(&dp->lock); in cdn_dp_connector_get_modes()
285 cdn_dp_connector_mode_valid(struct drm_connector *connector, in cdn_dp_connector_mode_valid() argument
288 struct cdn_dp_device *dp = connector_to_dp(connector); in cdn_dp_connector_mode_valid() local
289 struct drm_display_info *display_info = &dp->connector.display_info; in cdn_dp_connector_mode_valid()
293 /* If DP is disconnected, every mode is invalid */ in cdn_dp_connector_mode_valid()
294 if (!dp->connected) in cdn_dp_connector_mode_valid()
297 switch (display_info->bpc) { in cdn_dp_connector_mode_valid()
309 requested = mode->clock * bpc * 3 / 1000; in cdn_dp_connector_mode_valid()
311 source_max = dp->lanes; in cdn_dp_connector_mode_valid()
312 sink_max = drm_dp_max_lane_count(dp->dpcd); in cdn_dp_connector_mode_valid()
316 sink_max = drm_dp_max_link_rate(dp->dpcd); in cdn_dp_connector_mode_valid()
325 DRM_DEV_DEBUG_KMS(dp->dev, in cdn_dp_connector_mode_valid()
327 requested, actual, mode->clock); in cdn_dp_connector_mode_valid()
339 static int cdn_dp_firmware_init(struct cdn_dp_device *dp) in cdn_dp_firmware_init() argument
343 const struct firmware *fw = dp->fw; in cdn_dp_firmware_init()
346 hdr = (struct cdn_firmware_header *)fw->data; in cdn_dp_firmware_init()
347 if (fw->size != le32_to_cpu(hdr->size_bytes)) { in cdn_dp_firmware_init()
348 DRM_DEV_ERROR(dp->dev, "firmware is invalid\n"); in cdn_dp_firmware_init()
349 return -EINVAL; in cdn_dp_firmware_init()
352 iram_data = (const u32 *)(fw->data + hdr->header_size); in cdn_dp_firmware_init()
353 dram_data = (const u32 *)(fw->data + hdr->header_size + hdr->iram_size); in cdn_dp_firmware_init()
355 ret = cdn_dp_load_firmware(dp, iram_data, hdr->iram_size, in cdn_dp_firmware_init()
356 dram_data, hdr->dram_size); in cdn_dp_firmware_init()
360 ret = cdn_dp_set_firmware_active(dp, true); in cdn_dp_firmware_init()
362 DRM_DEV_ERROR(dp->dev, "active ucpu failed: %d\n", ret); in cdn_dp_firmware_init()
366 return cdn_dp_event_config(dp); in cdn_dp_firmware_init()
369 static int cdn_dp_get_sink_capability(struct cdn_dp_device *dp) in cdn_dp_get_sink_capability() argument
373 if (!cdn_dp_check_sink_connection(dp)) in cdn_dp_get_sink_capability()
374 return -ENODEV; in cdn_dp_get_sink_capability()
376 ret = cdn_dp_dpcd_read(dp, DP_DPCD_REV, dp->dpcd, in cdn_dp_get_sink_capability()
379 DRM_DEV_ERROR(dp->dev, "Failed to get caps %d\n", ret); in cdn_dp_get_sink_capability()
383 kfree(dp->edid); in cdn_dp_get_sink_capability()
384 dp->edid = drm_do_get_edid(&dp->connector, in cdn_dp_get_sink_capability()
385 cdn_dp_get_edid_block, dp); in cdn_dp_get_sink_capability()
389 static int cdn_dp_enable_phy(struct cdn_dp_device *dp, struct cdn_dp_port *port) in cdn_dp_enable_phy() argument
394 if (!port->phy_enabled) { in cdn_dp_enable_phy()
395 ret = phy_power_on(port->phy); in cdn_dp_enable_phy()
397 DRM_DEV_ERROR(dp->dev, "phy power on failed: %d\n", in cdn_dp_enable_phy()
401 port->phy_enabled = true; in cdn_dp_enable_phy()
404 ret = cdn_dp_grf_write(dp, GRF_SOC_CON26, in cdn_dp_enable_phy()
407 DRM_DEV_ERROR(dp->dev, "Failed to write HPD_SEL %d\n", ret); in cdn_dp_enable_phy()
411 ret = cdn_dp_get_hpd_status(dp); in cdn_dp_enable_phy()
414 DRM_DEV_ERROR(dp->dev, "hpd does not exist\n"); in cdn_dp_enable_phy()
418 ret = extcon_get_property(port->extcon, EXTCON_DISP_DP, in cdn_dp_enable_phy()
421 DRM_DEV_ERROR(dp->dev, "get property failed\n"); in cdn_dp_enable_phy()
425 port->lanes = cdn_dp_get_port_lanes(port); in cdn_dp_enable_phy()
426 ret = cdn_dp_set_host_cap(dp, port->lanes, property.intval); in cdn_dp_enable_phy()
428 DRM_DEV_ERROR(dp->dev, "set host capabilities failed: %d\n", in cdn_dp_enable_phy()
433 dp->active_port = port->id; in cdn_dp_enable_phy()
437 if (phy_power_off(port->phy)) in cdn_dp_enable_phy()
438 DRM_DEV_ERROR(dp->dev, "phy power off failed: %d", ret); in cdn_dp_enable_phy()
440 port->phy_enabled = false; in cdn_dp_enable_phy()
443 cdn_dp_grf_write(dp, GRF_SOC_CON26, in cdn_dp_enable_phy()
448 static int cdn_dp_disable_phy(struct cdn_dp_device *dp, in cdn_dp_disable_phy() argument
453 if (port->phy_enabled) { in cdn_dp_disable_phy()
454 ret = phy_power_off(port->phy); in cdn_dp_disable_phy()
456 DRM_DEV_ERROR(dp->dev, "phy power off failed: %d", ret); in cdn_dp_disable_phy()
461 port->phy_enabled = false; in cdn_dp_disable_phy()
462 port->lanes = 0; in cdn_dp_disable_phy()
463 dp->active_port = -1; in cdn_dp_disable_phy()
467 static int cdn_dp_disable(struct cdn_dp_device *dp) in cdn_dp_disable() argument
471 if (!dp->active) in cdn_dp_disable()
474 for (i = 0; i < dp->ports; i++) in cdn_dp_disable()
475 cdn_dp_disable_phy(dp, dp->port[i]); in cdn_dp_disable()
477 ret = cdn_dp_grf_write(dp, GRF_SOC_CON26, in cdn_dp_disable()
480 DRM_DEV_ERROR(dp->dev, "Failed to clear hpd sel %d\n", in cdn_dp_disable()
485 cdn_dp_set_firmware_active(dp, false); in cdn_dp_disable()
486 cdn_dp_clk_disable(dp); in cdn_dp_disable()
487 dp->active = false; in cdn_dp_disable()
488 dp->max_lanes = 0; in cdn_dp_disable()
489 dp->max_rate = 0; in cdn_dp_disable()
490 if (!dp->connected) { in cdn_dp_disable()
491 kfree(dp->edid); in cdn_dp_disable()
492 dp->edid = NULL; in cdn_dp_disable()
498 static int cdn_dp_enable(struct cdn_dp_device *dp) in cdn_dp_enable() argument
503 port = cdn_dp_connected_port(dp); in cdn_dp_enable()
505 DRM_DEV_ERROR(dp->dev, in cdn_dp_enable()
507 return -ENODEV; in cdn_dp_enable()
510 if (dp->active) in cdn_dp_enable()
513 ret = cdn_dp_clk_enable(dp); in cdn_dp_enable()
517 ret = cdn_dp_firmware_init(dp); in cdn_dp_enable()
519 DRM_DEV_ERROR(dp->dev, "firmware init failed: %d", ret); in cdn_dp_enable()
524 for (i = port->id; i < dp->ports; i++) { in cdn_dp_enable()
525 port = dp->port[i]; in cdn_dp_enable()
528 ret = cdn_dp_enable_phy(dp, port); in cdn_dp_enable()
532 ret = cdn_dp_get_sink_capability(dp); in cdn_dp_enable()
534 cdn_dp_disable_phy(dp, port); in cdn_dp_enable()
536 dp->active = true; in cdn_dp_enable()
537 dp->lanes = port->lanes; in cdn_dp_enable()
544 cdn_dp_clk_disable(dp); in cdn_dp_enable()
552 struct cdn_dp_device *dp = encoder_to_dp(encoder); in cdn_dp_encoder_mode_set() local
553 struct drm_display_info *display_info = &dp->connector.display_info; in cdn_dp_encoder_mode_set()
554 struct video_info *video = &dp->video_info; in cdn_dp_encoder_mode_set()
556 switch (display_info->bpc) { in cdn_dp_encoder_mode_set()
558 video->color_depth = 10; in cdn_dp_encoder_mode_set()
561 video->color_depth = 6; in cdn_dp_encoder_mode_set()
564 video->color_depth = 8; in cdn_dp_encoder_mode_set()
568 video->color_fmt = PXL_RGB; in cdn_dp_encoder_mode_set()
569 video->v_sync_polarity = !!(mode->flags & DRM_MODE_FLAG_NVSYNC); in cdn_dp_encoder_mode_set()
570 video->h_sync_polarity = !!(mode->flags & DRM_MODE_FLAG_NHSYNC); in cdn_dp_encoder_mode_set()
572 drm_mode_copy(&dp->mode, adjusted); in cdn_dp_encoder_mode_set()
575 static bool cdn_dp_check_link_status(struct cdn_dp_device *dp) in cdn_dp_check_link_status() argument
578 struct cdn_dp_port *port = cdn_dp_connected_port(dp); in cdn_dp_check_link_status()
579 u8 sink_lanes = drm_dp_max_lane_count(dp->dpcd); in cdn_dp_check_link_status()
581 if (!port || !dp->max_rate || !dp->max_lanes) in cdn_dp_check_link_status()
584 if (cdn_dp_dpcd_read(dp, DP_LANE0_1_STATUS, link_status, in cdn_dp_check_link_status()
591 return drm_dp_channel_eq_ok(link_status, min(port->lanes, sink_lanes)); in cdn_dp_check_link_status()
594 static void cdn_dp_audio_handle_plugged_change(struct cdn_dp_device *dp, in cdn_dp_audio_handle_plugged_change() argument
597 if (dp->codec_dev) in cdn_dp_audio_handle_plugged_change()
598 dp->plugged_cb(dp->codec_dev, plugged); in cdn_dp_audio_handle_plugged_change()
603 struct cdn_dp_device *dp = encoder_to_dp(encoder); in cdn_dp_encoder_enable() local
606 ret = drm_of_encoder_active_endpoint_id(dp->dev->of_node, encoder); in cdn_dp_encoder_enable()
608 DRM_DEV_ERROR(dp->dev, "Could not get vop id, %d", ret); in cdn_dp_encoder_enable()
612 DRM_DEV_DEBUG_KMS(dp->dev, "vop %s output to cdn-dp\n", in cdn_dp_encoder_enable()
619 ret = cdn_dp_grf_write(dp, GRF_SOC_CON9, val); in cdn_dp_encoder_enable()
623 mutex_lock(&dp->lock); in cdn_dp_encoder_enable()
625 ret = cdn_dp_enable(dp); in cdn_dp_encoder_enable()
627 DRM_DEV_ERROR(dp->dev, "Failed to enable encoder %d\n", in cdn_dp_encoder_enable()
631 if (!cdn_dp_check_link_status(dp)) { in cdn_dp_encoder_enable()
632 ret = cdn_dp_train_link(dp); in cdn_dp_encoder_enable()
634 DRM_DEV_ERROR(dp->dev, "Failed link train %d\n", ret); in cdn_dp_encoder_enable()
639 ret = cdn_dp_set_video_status(dp, CONTROL_VIDEO_IDLE); in cdn_dp_encoder_enable()
641 DRM_DEV_ERROR(dp->dev, "Failed to idle video %d\n", ret); in cdn_dp_encoder_enable()
645 ret = cdn_dp_config_video(dp); in cdn_dp_encoder_enable()
647 DRM_DEV_ERROR(dp->dev, "Failed to config video %d\n", ret); in cdn_dp_encoder_enable()
651 ret = cdn_dp_set_video_status(dp, CONTROL_VIDEO_VALID); in cdn_dp_encoder_enable()
653 DRM_DEV_ERROR(dp->dev, "Failed to valid video %d\n", ret); in cdn_dp_encoder_enable()
657 cdn_dp_audio_handle_plugged_change(dp, true); in cdn_dp_encoder_enable()
660 mutex_unlock(&dp->lock); in cdn_dp_encoder_enable()
665 struct cdn_dp_device *dp = encoder_to_dp(encoder); in cdn_dp_encoder_disable() local
668 mutex_lock(&dp->lock); in cdn_dp_encoder_disable()
669 cdn_dp_audio_handle_plugged_change(dp, false); in cdn_dp_encoder_disable()
671 if (dp->active) { in cdn_dp_encoder_disable()
672 ret = cdn_dp_disable(dp); in cdn_dp_encoder_disable()
674 DRM_DEV_ERROR(dp->dev, "Failed to disable encoder %d\n", in cdn_dp_encoder_disable()
678 mutex_unlock(&dp->lock); in cdn_dp_encoder_disable()
681 * In the following 2 cases, we need to run the event_work to re-enable in cdn_dp_encoder_disable()
682 * the DP: in cdn_dp_encoder_disable()
684 * device from a port, the DP will be disabled here, at this case, in cdn_dp_encoder_disable()
685 * run the event_work to re-open DP for the other port. in cdn_dp_encoder_disable()
686 * 2. If re-training or re-config failed, the DP will be disabled here. in cdn_dp_encoder_disable()
687 * run the event_work to re-connect it. in cdn_dp_encoder_disable()
689 if (!dp->connected && cdn_dp_connected_port(dp)) in cdn_dp_encoder_disable()
690 schedule_work(&dp->event_work); in cdn_dp_encoder_disable()
699 s->output_mode = ROCKCHIP_OUT_MODE_AAAA; in cdn_dp_encoder_atomic_check()
700 s->output_type = DRM_MODE_CONNECTOR_DisplayPort; in cdn_dp_encoder_atomic_check()
712 static int cdn_dp_parse_dt(struct cdn_dp_device *dp) in cdn_dp_parse_dt() argument
714 struct device *dev = dp->dev; in cdn_dp_parse_dt()
715 struct device_node *np = dev->of_node; in cdn_dp_parse_dt()
718 dp->grf = syscon_regmap_lookup_by_phandle(np, "rockchip,grf"); in cdn_dp_parse_dt()
719 if (IS_ERR(dp->grf)) { in cdn_dp_parse_dt()
720 DRM_DEV_ERROR(dev, "cdn-dp needs rockchip,grf property\n"); in cdn_dp_parse_dt()
721 return PTR_ERR(dp->grf); in cdn_dp_parse_dt()
724 dp->regs = devm_platform_ioremap_resource(pdev, 0); in cdn_dp_parse_dt()
725 if (IS_ERR(dp->regs)) { in cdn_dp_parse_dt()
727 return PTR_ERR(dp->regs); in cdn_dp_parse_dt()
730 dp->core_clk = devm_clk_get(dev, "core-clk"); in cdn_dp_parse_dt()
731 if (IS_ERR(dp->core_clk)) { in cdn_dp_parse_dt()
733 return PTR_ERR(dp->core_clk); in cdn_dp_parse_dt()
736 dp->pclk = devm_clk_get(dev, "pclk"); in cdn_dp_parse_dt()
737 if (IS_ERR(dp->pclk)) { in cdn_dp_parse_dt()
739 return PTR_ERR(dp->pclk); in cdn_dp_parse_dt()
742 dp->spdif_clk = devm_clk_get(dev, "spdif"); in cdn_dp_parse_dt()
743 if (IS_ERR(dp->spdif_clk)) { in cdn_dp_parse_dt()
745 return PTR_ERR(dp->spdif_clk); in cdn_dp_parse_dt()
748 dp->grf_clk = devm_clk_get(dev, "grf"); in cdn_dp_parse_dt()
749 if (IS_ERR(dp->grf_clk)) { in cdn_dp_parse_dt()
751 return PTR_ERR(dp->grf_clk); in cdn_dp_parse_dt()
754 dp->spdif_rst = devm_reset_control_get(dev, "spdif"); in cdn_dp_parse_dt()
755 if (IS_ERR(dp->spdif_rst)) { in cdn_dp_parse_dt()
757 return PTR_ERR(dp->spdif_rst); in cdn_dp_parse_dt()
760 dp->dptx_rst = devm_reset_control_get(dev, "dptx"); in cdn_dp_parse_dt()
761 if (IS_ERR(dp->dptx_rst)) { in cdn_dp_parse_dt()
763 return PTR_ERR(dp->dptx_rst); in cdn_dp_parse_dt()
766 dp->core_rst = devm_reset_control_get(dev, "core"); in cdn_dp_parse_dt()
767 if (IS_ERR(dp->core_rst)) { in cdn_dp_parse_dt()
769 return PTR_ERR(dp->core_rst); in cdn_dp_parse_dt()
772 dp->apb_rst = devm_reset_control_get(dev, "apb"); in cdn_dp_parse_dt()
773 if (IS_ERR(dp->apb_rst)) { in cdn_dp_parse_dt()
775 return PTR_ERR(dp->apb_rst); in cdn_dp_parse_dt()
785 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_audio_hw_params() local
787 .sample_width = params->sample_width, in cdn_dp_audio_hw_params()
788 .sample_rate = params->sample_rate, in cdn_dp_audio_hw_params()
789 .channels = params->channels, in cdn_dp_audio_hw_params()
793 mutex_lock(&dp->lock); in cdn_dp_audio_hw_params()
794 if (!dp->active) { in cdn_dp_audio_hw_params()
795 ret = -ENODEV; in cdn_dp_audio_hw_params()
799 switch (daifmt->fmt) { in cdn_dp_audio_hw_params()
807 DRM_DEV_ERROR(dev, "Invalid format %d\n", daifmt->fmt); in cdn_dp_audio_hw_params()
808 ret = -EINVAL; in cdn_dp_audio_hw_params()
812 ret = cdn_dp_audio_config(dp, &audio); in cdn_dp_audio_hw_params()
814 dp->audio_info = audio; in cdn_dp_audio_hw_params()
817 mutex_unlock(&dp->lock); in cdn_dp_audio_hw_params()
823 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_audio_shutdown() local
826 mutex_lock(&dp->lock); in cdn_dp_audio_shutdown()
827 if (!dp->active) in cdn_dp_audio_shutdown()
830 ret = cdn_dp_audio_stop(dp, &dp->audio_info); in cdn_dp_audio_shutdown()
832 dp->audio_info.format = AFMT_UNUSED; in cdn_dp_audio_shutdown()
834 mutex_unlock(&dp->lock); in cdn_dp_audio_shutdown()
840 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_audio_mute_stream() local
843 mutex_lock(&dp->lock); in cdn_dp_audio_mute_stream()
844 if (!dp->active) { in cdn_dp_audio_mute_stream()
845 ret = -ENODEV; in cdn_dp_audio_mute_stream()
849 ret = cdn_dp_audio_mute(dp, enable); in cdn_dp_audio_mute_stream()
852 mutex_unlock(&dp->lock); in cdn_dp_audio_mute_stream()
859 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_audio_get_eld() local
861 memcpy(buf, dp->connector.eld, min(sizeof(dp->connector.eld), len)); in cdn_dp_audio_get_eld()
870 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_audio_hook_plugged_cb() local
872 mutex_lock(&dp->lock); in cdn_dp_audio_hook_plugged_cb()
873 dp->plugged_cb = fn; in cdn_dp_audio_hook_plugged_cb()
874 dp->codec_dev = codec_dev; in cdn_dp_audio_hook_plugged_cb()
875 cdn_dp_audio_handle_plugged_change(dp, dp->connected); in cdn_dp_audio_hook_plugged_cb()
876 mutex_unlock(&dp->lock); in cdn_dp_audio_hook_plugged_cb()
890 static int cdn_dp_audio_codec_init(struct cdn_dp_device *dp, in cdn_dp_audio_codec_init() argument
900 dp->audio_pdev = platform_device_register_data( in cdn_dp_audio_codec_init()
904 return PTR_ERR_OR_ZERO(dp->audio_pdev); in cdn_dp_audio_codec_init()
907 static int cdn_dp_request_firmware(struct cdn_dp_device *dp) in cdn_dp_request_firmware() argument
913 WARN_ON(!mutex_is_locked(&dp->lock)); in cdn_dp_request_firmware()
915 if (dp->fw_loaded) in cdn_dp_request_firmware()
919 mutex_unlock(&dp->lock); in cdn_dp_request_firmware()
922 ret = request_firmware(&dp->fw, CDN_DP_FIRMWARE, dp->dev); in cdn_dp_request_firmware()
923 if (ret == -ENOENT) { in cdn_dp_request_firmware()
928 DRM_DEV_ERROR(dp->dev, in cdn_dp_request_firmware()
933 dp->fw_loaded = true; in cdn_dp_request_firmware()
938 DRM_DEV_ERROR(dp->dev, "Timed out trying to load firmware\n"); in cdn_dp_request_firmware()
939 ret = -ETIMEDOUT; in cdn_dp_request_firmware()
941 mutex_lock(&dp->lock); in cdn_dp_request_firmware()
947 struct cdn_dp_device *dp = container_of(work, struct cdn_dp_device, in cdn_dp_pd_event_work() local
949 struct drm_connector *connector = &dp->connector; in cdn_dp_pd_event_work() local
954 mutex_lock(&dp->lock); in cdn_dp_pd_event_work()
956 if (dp->suspended) in cdn_dp_pd_event_work()
959 ret = cdn_dp_request_firmware(dp); in cdn_dp_pd_event_work()
963 dp->connected = true; in cdn_dp_pd_event_work()
966 if (!cdn_dp_connected_port(dp)) { in cdn_dp_pd_event_work()
967 DRM_DEV_INFO(dp->dev, "Not connected. Disabling cdn\n"); in cdn_dp_pd_event_work()
968 dp->connected = false; in cdn_dp_pd_event_work()
971 } else if (!dp->active) { in cdn_dp_pd_event_work()
972 DRM_DEV_INFO(dp->dev, "Connected, not enabled. Enabling cdn\n"); in cdn_dp_pd_event_work()
973 ret = cdn_dp_enable(dp); in cdn_dp_pd_event_work()
975 DRM_DEV_ERROR(dp->dev, "Enable dp failed %d\n", ret); in cdn_dp_pd_event_work()
976 dp->connected = false; in cdn_dp_pd_event_work()
980 } else if (!cdn_dp_check_sink_connection(dp)) { in cdn_dp_pd_event_work()
981 DRM_DEV_INFO(dp->dev, "Connected without sink. Assert hpd\n"); in cdn_dp_pd_event_work()
982 dp->connected = false; in cdn_dp_pd_event_work()
984 /* Enabled and connected with a sink, re-train if requested */ in cdn_dp_pd_event_work()
985 } else if (!cdn_dp_check_link_status(dp)) { in cdn_dp_pd_event_work()
986 unsigned int rate = dp->max_rate; in cdn_dp_pd_event_work()
987 unsigned int lanes = dp->max_lanes; in cdn_dp_pd_event_work()
988 struct drm_display_mode *mode = &dp->mode; in cdn_dp_pd_event_work()
990 DRM_DEV_INFO(dp->dev, "Connected with sink. Re-train link\n"); in cdn_dp_pd_event_work()
991 ret = cdn_dp_train_link(dp); in cdn_dp_pd_event_work()
993 dp->connected = false; in cdn_dp_pd_event_work()
994 DRM_DEV_ERROR(dp->dev, "Train link failed %d\n", ret); in cdn_dp_pd_event_work()
999 if (mode->clock && in cdn_dp_pd_event_work()
1000 (rate != dp->max_rate || lanes != dp->max_lanes)) { in cdn_dp_pd_event_work()
1001 ret = cdn_dp_config_video(dp); in cdn_dp_pd_event_work()
1003 dp->connected = false; in cdn_dp_pd_event_work()
1004 DRM_DEV_ERROR(dp->dev, in cdn_dp_pd_event_work()
1012 mutex_unlock(&dp->lock); in cdn_dp_pd_event_work()
1014 old_status = connector->status; in cdn_dp_pd_event_work()
1015 connector->status = connector->funcs->detect(connector, false); in cdn_dp_pd_event_work()
1016 if (old_status != connector->status) in cdn_dp_pd_event_work()
1017 drm_kms_helper_hotplug_event(dp->drm_dev); in cdn_dp_pd_event_work()
1025 struct cdn_dp_device *dp = port->dp; in cdn_dp_pd_event() local
1032 schedule_work(&dp->event_work); in cdn_dp_pd_event()
1039 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_bind() local
1041 struct drm_connector *connector; in cdn_dp_bind() local
1046 ret = cdn_dp_parse_dt(dp); in cdn_dp_bind()
1050 dp->drm_dev = drm_dev; in cdn_dp_bind()
1051 dp->connected = false; in cdn_dp_bind()
1052 dp->active = false; in cdn_dp_bind()
1053 dp->active_port = -1; in cdn_dp_bind()
1054 dp->fw_loaded = false; in cdn_dp_bind()
1056 INIT_WORK(&dp->event_work, cdn_dp_pd_event_work); in cdn_dp_bind()
1058 encoder = &dp->encoder.encoder; in cdn_dp_bind()
1060 encoder->possible_crtcs = drm_of_find_possible_crtcs(drm_dev, in cdn_dp_bind()
1061 dev->of_node); in cdn_dp_bind()
1062 DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs); in cdn_dp_bind()
1073 connector = &dp->connector; in cdn_dp_bind()
1074 connector->polled = DRM_CONNECTOR_POLL_HPD; in cdn_dp_bind()
1075 connector->dpms = DRM_MODE_DPMS_OFF; in cdn_dp_bind()
1077 ret = drm_connector_init(drm_dev, connector, in cdn_dp_bind()
1081 DRM_ERROR("failed to initialize connector with drm\n"); in cdn_dp_bind()
1085 drm_connector_helper_add(connector, &cdn_dp_connector_helper_funcs); in cdn_dp_bind()
1087 ret = drm_connector_attach_encoder(connector, encoder); in cdn_dp_bind()
1089 DRM_ERROR("failed to attach connector and encoder\n"); in cdn_dp_bind()
1093 for (i = 0; i < dp->ports; i++) { in cdn_dp_bind()
1094 port = dp->port[i]; in cdn_dp_bind()
1096 port->event_nb.notifier_call = cdn_dp_pd_event; in cdn_dp_bind()
1097 ret = devm_extcon_register_notifier(dp->dev, port->extcon, in cdn_dp_bind()
1099 &port->event_nb); in cdn_dp_bind()
1109 schedule_work(&dp->event_work); in cdn_dp_bind()
1114 drm_connector_cleanup(connector); in cdn_dp_bind()
1122 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_unbind() local
1123 struct drm_encoder *encoder = &dp->encoder.encoder; in cdn_dp_unbind()
1124 struct drm_connector *connector = &dp->connector; in cdn_dp_unbind() local
1126 cancel_work_sync(&dp->event_work); in cdn_dp_unbind()
1128 encoder->funcs->destroy(encoder); in cdn_dp_unbind()
1129 connector->funcs->destroy(connector); in cdn_dp_unbind()
1132 if (dp->fw_loaded) in cdn_dp_unbind()
1133 release_firmware(dp->fw); in cdn_dp_unbind()
1134 kfree(dp->edid); in cdn_dp_unbind()
1135 dp->edid = NULL; in cdn_dp_unbind()
1145 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_suspend() local
1148 mutex_lock(&dp->lock); in cdn_dp_suspend()
1149 if (dp->active) in cdn_dp_suspend()
1150 ret = cdn_dp_disable(dp); in cdn_dp_suspend()
1151 dp->suspended = true; in cdn_dp_suspend()
1152 mutex_unlock(&dp->lock); in cdn_dp_suspend()
1159 struct cdn_dp_device *dp = dev_get_drvdata(dev); in cdn_dp_resume() local
1161 mutex_lock(&dp->lock); in cdn_dp_resume()
1162 dp->suspended = false; in cdn_dp_resume()
1163 if (dp->fw_loaded) in cdn_dp_resume()
1164 schedule_work(&dp->event_work); in cdn_dp_resume()
1165 mutex_unlock(&dp->lock); in cdn_dp_resume()
1172 struct device *dev = &pdev->dev; in cdn_dp_probe()
1176 struct cdn_dp_device *dp; in cdn_dp_probe() local
1182 dp = devm_kzalloc(dev, sizeof(*dp), GFP_KERNEL); in cdn_dp_probe()
1183 if (!dp) in cdn_dp_probe()
1184 return -ENOMEM; in cdn_dp_probe()
1185 dp->dev = dev; in cdn_dp_probe()
1187 match = of_match_node(cdn_dp_dt_ids, pdev->dev.of_node); in cdn_dp_probe()
1188 dp_data = (struct cdn_dp_data *)match->data; in cdn_dp_probe()
1190 for (i = 0; i < dp_data->max_phy; i++) { in cdn_dp_probe()
1192 phy = devm_of_phy_get_by_index(dev, dev->of_node, i); in cdn_dp_probe()
1194 if (PTR_ERR(extcon) == -EPROBE_DEFER || in cdn_dp_probe()
1195 PTR_ERR(phy) == -EPROBE_DEFER) in cdn_dp_probe()
1196 return -EPROBE_DEFER; in cdn_dp_probe()
1203 return -ENOMEM; in cdn_dp_probe()
1205 port->extcon = extcon; in cdn_dp_probe()
1206 port->phy = phy; in cdn_dp_probe()
1207 port->dp = dp; in cdn_dp_probe()
1208 port->id = i; in cdn_dp_probe()
1209 dp->port[dp->ports++] = port; in cdn_dp_probe()
1212 if (!dp->ports) { in cdn_dp_probe()
1214 return -EINVAL; in cdn_dp_probe()
1217 mutex_init(&dp->lock); in cdn_dp_probe()
1218 dev_set_drvdata(dev, dp); in cdn_dp_probe()
1220 ret = cdn_dp_audio_codec_init(dp, dev); in cdn_dp_probe()
1231 platform_device_unregister(dp->audio_pdev); in cdn_dp_probe()
1237 struct cdn_dp_device *dp = platform_get_drvdata(pdev); in cdn_dp_remove() local
1239 platform_device_unregister(dp->audio_pdev); in cdn_dp_remove()
1240 cdn_dp_suspend(dp->dev); in cdn_dp_remove()
1241 component_del(&pdev->dev, &cdn_dp_component_ops); in cdn_dp_remove()
1246 struct cdn_dp_device *dp = platform_get_drvdata(pdev); in cdn_dp_shutdown() local
1248 cdn_dp_suspend(dp->dev); in cdn_dp_shutdown()
1261 .name = "cdn-dp",