Lines Matching +full:mediatek +full:- +full:display
1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (c) 2019-2022 MediaTek Inc.
7 #include <drm/display/drm_dp_aux_bus.h>
8 #include <drm/display/drm_dp.h>
9 #include <drm/display/drm_dp_helper.h>
18 #include <linux/arm-smccc.h>
23 #include <linux/media-bus-format.h>
24 #include <linux/nvmem-consumer.h>
32 #include <linux/soc/mediatek/mtk_sip_svc.h>
33 #include <sound/hdmi-codec.h>
402 .name = "mtk-dp-registers",
415 ret = regmap_read(mtk_dp->regs, offset, &read_val); in mtk_dp_read()
417 dev_err(mtk_dp->dev, "Failed to read register 0x%x: %d\n", in mtk_dp_read()
427 int ret = regmap_write(mtk_dp->regs, offset, val); in mtk_dp_write()
430 dev_err(mtk_dp->dev, in mtk_dp_write()
439 int ret = regmap_update_bits(mtk_dp->regs, offset, mask, val); in mtk_dp_update_bits()
442 dev_err(mtk_dp->dev, in mtk_dp_update_bits()
476 struct videomode *vm = &mtk_dp->info.vm; in mtk_dp_set_msa()
484 vm->hsync_len + vm->hback_porch, in mtk_dp_set_msa()
487 vm->hsync_len, HSW_SW_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
491 vm->hactive, HWIDTH_SW_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
497 vm->vsync_len + vm->vback_porch, in mtk_dp_set_msa()
500 vm->vsync_len, VSW_SW_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
504 vm->vactive, VHEIGHT_SW_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
508 vm->hactive, HDE_NUM_LAST_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
512 vm->hfront_porch, in mtk_dp_set_msa()
515 vm->hsync_len, in mtk_dp_set_msa()
518 vm->hback_porch + vm->hsync_len, in mtk_dp_set_msa()
521 vm->hactive, in mtk_dp_set_msa()
529 vm->vfront_porch, in mtk_dp_set_msa()
532 vm->vsync_len, in mtk_dp_set_msa()
535 vm->vback_porch + vm->vsync_len, in mtk_dp_set_msa()
538 vm->vactive, in mtk_dp_set_msa()
558 drm_warn(mtk_dp->drm_dev, "Unsupported color format: %d\n", in mtk_dp_set_color_format()
560 return -EINVAL; in mtk_dp_set_color_format()
647 switch (cfg->channels) { in mtk_dp_audio_setup_channels()
680 switch (cfg->sample_rate) { in mtk_dp_audio_channel_status_set()
704 switch (cfg->word_length_bits) { in mtk_dp_audio_channel_status_set()
733 (min(8, channels) - 1) << 8, in mtk_dp_audio_sdp_asp_set_channels()
740 mtk_dp->data->audio_m_div2_bit, in mtk_dp_audio_set_divider()
761 u32 db_addr = MTK_DP_ENC0_P0_30D8 + (MTK_DP_SDP_AUI - 1) * 8; in mtk_dp_sdp_set_header_aui()
778 mtk_dp_sdp_set_data(mtk_dp, sdp->db); in mtk_dp_setup_sdp_aui()
779 mtk_dp_sdp_set_header_aui(mtk_dp, &sdp->sdp_header); in mtk_dp_setup_sdp_aui()
851 (length - 1) << 12, in mtk_dp_aux_set_length()
871 while (--wait_reply) { in mtk_dp_aux_wait_for_completion()
889 return -ETIMEDOUT; in mtk_dp_aux_wait_for_completion()
895 return -ETIMEDOUT; in mtk_dp_aux_wait_for_completion()
905 return -EINVAL; in mtk_dp_aux_do_transfer()
940 dev_err(mtk_dp->dev, in mtk_dp_aux_do_transfer()
942 return -EIO; in mtk_dp_aux_do_transfer()
945 return -ETIMEDOUT; in mtk_dp_aux_do_transfer()
974 dev_dbg(mtk_dp->dev, in mtk_dp_set_swing_pre_emphasis()
975 "link training: swing_val = 0x%x, pre-emphasis = 0x%x\n", in mtk_dp_set_swing_pre_emphasis()
1155 struct device *dev = mtk_dp->dev; in mtk_dp_get_calibration_data()
1157 u32 *cal_data = mtk_dp->cal_data; in mtk_dp_get_calibration_data()
1181 fmt = &mtk_dp->data->efuse_fmt[i]; in mtk_dp_get_calibration_data()
1182 cal_data[i] = (buf[fmt->idx] >> fmt->shift) & fmt->mask; in mtk_dp_get_calibration_data()
1184 if (cal_data[i] < fmt->min_val || cal_data[i] > fmt->max_val) { in mtk_dp_get_calibration_data()
1185 dev_warn(mtk_dp->dev, "Invalid efuse data, idx = %d\n", i); in mtk_dp_get_calibration_data()
1195 dev_warn(mtk_dp->dev, "Use default calibration data\n"); in mtk_dp_get_calibration_data()
1197 cal_data[i] = mtk_dp->data->efuse_fmt[i].default_val; in mtk_dp_get_calibration_data()
1202 u32 *cal_data = mtk_dp->cal_data; in mtk_dp_set_calibration_data()
1246 .ssc = mtk_dp->train_info.sink_ssc, in mtk_dp_phy_configure()
1253 ret = phy_configure(mtk_dp->phy, &phy_opts); in mtk_dp_phy_configure()
1283 pattern ? BIT(pattern - 1) << 12 : 0, in mtk_dp_train_set_pattern()
1316 mtk_dp->data->smc_cmd, enable, in mtk_dp_video_mute()
1319 dev_dbg(mtk_dp->dev, "smc cmd: 0x%x, p1: %s, ret: 0x%lx-0x%lx\n", in mtk_dp_video_mute()
1320 mtk_dp->data->smc_cmd, enable ? "enable" : "disable", res.a0, res.a1); in mtk_dp_video_mute()
1358 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D0); in mtk_dp_aux_panel_poweron()
1362 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D3); in mtk_dp_aux_panel_poweron()
1405 bool plugged_in = (mtk_dp->bridge.type == DRM_MODE_CONNECTOR_eDP); in mtk_dp_initialize_priv_data()
1407 mtk_dp->train_info.link_rate = DP_LINK_BW_5_4; in mtk_dp_initialize_priv_data()
1408 mtk_dp->train_info.lane_count = mtk_dp->max_lanes; in mtk_dp_initialize_priv_data()
1409 mtk_dp->train_info.cable_plugged_in = plugged_in; in mtk_dp_initialize_priv_data()
1411 mtk_dp->info.format = DP_PIXELFORMAT_RGB; in mtk_dp_initialize_priv_data()
1412 memset(&mtk_dp->info.vm, 0, sizeof(struct videomode)); in mtk_dp_initialize_priv_data()
1413 mtk_dp->audio_enable = false; in mtk_dp_initialize_priv_data()
1421 struct videomode *vm = &mtk_dp->info.vm; in mtk_dp_sdp_set_down_cnt_init()
1427 mtk_dp->train_info.link_rate * 2700 * 8 / in mtk_dp_sdp_set_down_cnt_init()
1430 switch (mtk_dp->train_info.lane_count) { in mtk_dp_sdp_set_down_cnt_init()
1456 struct videomode *vm = &mtk_dp->info.vm; in mtk_dp_sdp_set_down_cnt_init_in_hblank()
1460 pix_clk_mhz = mtk_dp->info.format == DP_PIXELFORMAT_YUV420 ? in mtk_dp_sdp_set_down_cnt_init_in_hblank()
1463 switch (mtk_dp->train_info.lane_count) { in mtk_dp_sdp_set_down_cnt_init_in_hblank()
1474 if (pix_clk_mhz > mtk_dp->train_info.link_rate * 27) in mtk_dp_sdp_set_down_cnt_init_in_hblank()
1488 if (!mtk_dp->data->audio_pkt_in_hblank_area) in mtk_dp_audio_sample_arrange_disable()
1500 mtk_dp->info.vm.hactive / in mtk_dp_setup_tu()
1501 mtk_dp->train_info.lane_count / in mtk_dp_setup_tu()
1542 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_LANE0_SET + lane, in mtk_dp_train_update_swing_pre()
1556 aux_offset = mtk_dp->train_info.channel_eq_pattern; in mtk_dp_pattern()
1558 switch (mtk_dp->train_info.channel_eq_pattern) { in mtk_dp_pattern()
1575 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, aux_offset); in mtk_dp_pattern()
1583 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_LINK_BW_SET, target_link_rate); in mtk_dp_train_setting()
1584 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_LANE_COUNT_SET, in mtk_dp_train_setting()
1587 if (mtk_dp->train_info.sink_ssc) in mtk_dp_train_setting()
1588 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_DOWNSPREAD_CTRL, in mtk_dp_train_setting()
1596 dev_dbg(mtk_dp->dev, in mtk_dp_train_setting()
1616 if (!mtk_dp->train_info.cable_plugged_in) { in mtk_dp_train_cr()
1618 return -ENODEV; in mtk_dp_train_cr()
1621 drm_dp_dpcd_read(&mtk_dp->aux, DP_ADJUST_REQUEST_LANE0_1, in mtk_dp_train_cr()
1626 drm_dp_link_train_clock_recovery_delay(&mtk_dp->aux, in mtk_dp_train_cr()
1627 mtk_dp->rx_cap); in mtk_dp_train_cr()
1630 drm_dp_dpcd_read_link_status(&mtk_dp->aux, link_status); in mtk_dp_train_cr()
1633 dev_dbg(mtk_dp->dev, "Link train CR pass\n"); in mtk_dp_train_cr()
1653 dev_dbg(mtk_dp->dev, "Link train CR fail\n"); in mtk_dp_train_cr()
1659 * re-calculate this retry count. in mtk_dp_train_cr()
1667 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, in mtk_dp_train_cr()
1671 return -ETIMEDOUT; in mtk_dp_train_cr()
1684 if (!mtk_dp->train_info.cable_plugged_in) { in mtk_dp_train_eq()
1686 return -ENODEV; in mtk_dp_train_eq()
1689 drm_dp_dpcd_read(&mtk_dp->aux, DP_ADJUST_REQUEST_LANE0_1, in mtk_dp_train_eq()
1694 drm_dp_link_train_channel_eq_delay(&mtk_dp->aux, in mtk_dp_train_eq()
1695 mtk_dp->rx_cap); in mtk_dp_train_eq()
1698 drm_dp_dpcd_read_link_status(&mtk_dp->aux, link_status); in mtk_dp_train_eq()
1700 dev_dbg(mtk_dp->dev, "Link train EQ pass\n"); in mtk_dp_train_eq()
1703 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, in mtk_dp_train_eq()
1708 dev_dbg(mtk_dp->dev, "Link train EQ fail\n"); in mtk_dp_train_eq()
1712 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, in mtk_dp_train_eq()
1716 return -ETIMEDOUT; in mtk_dp_train_eq()
1729 if (mtk_dp->bridge.type == DRM_MODE_CONNECTOR_eDP && in mtk_dp_parse_capabilities()
1730 mtk_dp->rx_cap[DP_MAX_LINK_RATE] && in mtk_dp_parse_capabilities()
1731 mtk_dp->train_info.sink_ssc) in mtk_dp_parse_capabilities()
1734 ret = drm_dp_read_dpcd_caps(&mtk_dp->aux, mtk_dp->rx_cap); in mtk_dp_parse_capabilities()
1738 if (drm_dp_tps4_supported(mtk_dp->rx_cap)) in mtk_dp_parse_capabilities()
1739 mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_4; in mtk_dp_parse_capabilities()
1740 else if (drm_dp_tps3_supported(mtk_dp->rx_cap)) in mtk_dp_parse_capabilities()
1741 mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_3; in mtk_dp_parse_capabilities()
1743 mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_2; in mtk_dp_parse_capabilities()
1745 mtk_dp->train_info.sink_ssc = drm_dp_max_downspread(mtk_dp->rx_cap); in mtk_dp_parse_capabilities()
1747 ret = drm_dp_dpcd_readb(&mtk_dp->aux, DP_MSTM_CAP, &val); in mtk_dp_parse_capabilities()
1749 dev_err(mtk_dp->dev, "Read mstm cap failed: %zd\n", ret); in mtk_dp_parse_capabilities()
1750 return ret == 0 ? -EIO : ret; in mtk_dp_parse_capabilities()
1755 ret = drm_dp_dpcd_readb(&mtk_dp->aux, in mtk_dp_parse_capabilities()
1759 dev_err(mtk_dp->dev, "Read irq vector failed: %zd\n", ret); in mtk_dp_parse_capabilities()
1760 return ret == 0 ? -EIO : ret; in mtk_dp_parse_capabilities()
1764 ret = drm_dp_dpcd_writeb(&mtk_dp->aux, in mtk_dp_parse_capabilities()
1778 if (!mtk_dp->data->audio_supported) in mtk_dp_edid_parse_audio_capabilities()
1781 if (mtk_dp->info.audio_cur_cfg.sad_count <= 0) { in mtk_dp_edid_parse_audio_capabilities()
1782 drm_info(mtk_dp->drm_dev, "The SADs is NULL\n"); in mtk_dp_edid_parse_audio_capabilities()
1791 phy_reset(mtk_dp->phy); in mtk_dp_train_change_mode()
1800 link_rate = min_t(u8, mtk_dp->max_linkrate, in mtk_dp_training()
1801 mtk_dp->rx_cap[DP_MAX_LINK_RATE]); in mtk_dp_training()
1803 lane_count = min_t(u8, mtk_dp->max_lanes, in mtk_dp_training()
1804 drm_dp_max_lane_count(mtk_dp->rx_cap)); in mtk_dp_training()
1813 for (train_limit = 6; train_limit > 0; train_limit--) { in mtk_dp_training()
1821 if (ret == -ENODEV) { in mtk_dp_training()
1830 return -EIO; in mtk_dp_training()
1842 return -EINVAL; in mtk_dp_training()
1848 if (ret == -ENODEV) { in mtk_dp_training()
1853 return -EIO; in mtk_dp_training()
1863 return -ETIMEDOUT; in mtk_dp_training()
1865 mtk_dp->train_info.link_rate = link_rate; in mtk_dp_training()
1866 mtk_dp->train_info.lane_count = lane_count; in mtk_dp_training()
1901 frame.channels = cfg->channels; in mtk_dp_audio_sdp_setup()
1902 frame.sample_frequency = cfg->sample_rate; in mtk_dp_audio_sdp_setup()
1904 switch (cfg->word_length_bits) { in mtk_dp_audio_sdp_setup()
1919 mtk_dp_audio_sdp_asp_set_channels(mtk_dp, cfg->channels); in mtk_dp_audio_sdp_setup()
1938 return mtk_dp_set_color_format(mtk_dp, mtk_dp->info.format); in mtk_dp_video_config()
1960 if (mtk_dp->need_debounce && mtk_dp->train_info.cable_plugged_in) in mtk_dp_hpd_event_thread()
1963 spin_lock_irqsave(&mtk_dp->irq_thread_lock, flags); in mtk_dp_hpd_event_thread()
1964 status = mtk_dp->irq_thread_handle; in mtk_dp_hpd_event_thread()
1965 mtk_dp->irq_thread_handle = 0; in mtk_dp_hpd_event_thread()
1966 spin_unlock_irqrestore(&mtk_dp->irq_thread_lock, flags); in mtk_dp_hpd_event_thread()
1969 if (mtk_dp->bridge.dev) in mtk_dp_hpd_event_thread()
1970 drm_helper_hpd_irq_event(mtk_dp->bridge.dev); in mtk_dp_hpd_event_thread()
1972 if (!mtk_dp->train_info.cable_plugged_in) { in mtk_dp_hpd_event_thread()
1974 memset(&mtk_dp->info.audio_cur_cfg, 0, in mtk_dp_hpd_event_thread()
1975 sizeof(mtk_dp->info.audio_cur_cfg)); in mtk_dp_hpd_event_thread()
1977 mtk_dp->need_debounce = false; in mtk_dp_hpd_event_thread()
1978 mod_timer(&mtk_dp->debounce_timer, in mtk_dp_hpd_event_thread()
1979 jiffies + msecs_to_jiffies(100) - 1); in mtk_dp_hpd_event_thread()
1984 dev_dbg(mtk_dp->dev, "Receive IRQ from sink devices\n"); in mtk_dp_hpd_event_thread()
2000 spin_lock_irqsave(&mtk_dp->irq_thread_lock, flags); in mtk_dp_hpd_event()
2003 mtk_dp->irq_thread_handle |= MTK_DP_THREAD_HPD_EVENT; in mtk_dp_hpd_event()
2007 mtk_dp->irq_thread_handle |= MTK_DP_THREAD_CABLE_STATE_CHG; in mtk_dp_hpd_event()
2011 spin_unlock_irqrestore(&mtk_dp->irq_thread_lock, flags); in mtk_dp_hpd_event()
2016 mtk_dp->train_info.cable_plugged_in = true; in mtk_dp_hpd_event()
2018 mtk_dp->train_info.cable_plugged_in = false; in mtk_dp_hpd_event()
2030 ret = regmap_read_poll_timeout(mtk_dp->regs, MTK_DP_TRANS_P0_3414, in mtk_dp_wait_hpd_asserted()
2034 mtk_dp->train_info.cable_plugged_in = false; in mtk_dp_wait_hpd_asserted()
2038 mtk_dp->train_info.cable_plugged_in = true; in mtk_dp_wait_hpd_asserted()
2042 dev_err(mtk_dp->dev, "Can't parse capabilities: %d\n", ret); in mtk_dp_wait_hpd_asserted()
2053 struct device *dev = &pdev->dev; in mtk_dp_dt_parse()
2063 mtk_dp->regs = devm_regmap_init_mmio(dev, base, &mtk_dp_regmap_config); in mtk_dp_dt_parse()
2064 if (IS_ERR(mtk_dp->regs)) in mtk_dp_dt_parse()
2065 return PTR_ERR(mtk_dp->regs); in mtk_dp_dt_parse()
2067 endpoint = of_graph_get_endpoint_by_regs(pdev->dev.of_node, 1, -1); in mtk_dp_dt_parse()
2069 "data-lanes", sizeof(u32)); in mtk_dp_dt_parse()
2072 return -EINVAL; in mtk_dp_dt_parse()
2075 mtk_dp->max_lanes = len; in mtk_dp_dt_parse()
2077 ret = device_property_read_u32(dev, "max-linkrate-mhz", &linkrate); in mtk_dp_dt_parse()
2083 mtk_dp->max_linkrate = drm_dp_link_rate_to_bw_code(linkrate * 100); in mtk_dp_dt_parse()
2090 if (!mtk_dp->data->audio_supported || !mtk_dp->audio_enable) in mtk_dp_update_plugged_status()
2093 mutex_lock(&mtk_dp->update_plugged_status_lock); in mtk_dp_update_plugged_status()
2094 if (mtk_dp->plugged_cb && mtk_dp->codec_dev) in mtk_dp_update_plugged_status()
2095 mtk_dp->plugged_cb(mtk_dp->codec_dev, in mtk_dp_update_plugged_status()
2096 mtk_dp->enabled & in mtk_dp_update_plugged_status()
2097 mtk_dp->info.audio_cur_cfg.detect_monitor); in mtk_dp_update_plugged_status()
2098 mutex_unlock(&mtk_dp->update_plugged_status_lock); in mtk_dp_update_plugged_status()
2105 bool enabled = mtk_dp->enabled; in mtk_dp_bdg_detect()
2107 if (!mtk_dp->train_info.cable_plugged_in) in mtk_dp_bdg_detect()
2121 if (drm_dp_read_sink_count(&mtk_dp->aux) > 0) in mtk_dp_bdg_detect()
2134 bool enabled = mtk_dp->enabled; in mtk_dp_edid_read()
2136 struct mtk_dp_audio_cfg *audio_caps = &mtk_dp->info.audio_cur_cfg; in mtk_dp_edid_read()
2139 drm_atomic_bridge_chain_pre_enable(bridge, connector->state->state); in mtk_dp_edid_read()
2143 drm_edid = drm_edid_read_ddc(connector, &mtk_dp->aux.ddc); in mtk_dp_edid_read()
2150 drm_err(mtk_dp->drm_dev, "Can't parse capabilities\n"); in mtk_dp_edid_read()
2169 audio_caps->sad_count = ret; in mtk_dp_edid_read()
2172 * FIXME: This should use connector->display_info.has_audio from in mtk_dp_edid_read()
2176 audio_caps->detect_monitor = drm_detect_monitor_audio(edid); in mtk_dp_edid_read()
2181 drm_atomic_bridge_chain_post_disable(bridge, connector->state->state); in mtk_dp_edid_read()
2196 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP && in mtk_dp_aux_transfer()
2197 !mtk_dp->train_info.cable_plugged_in) { in mtk_dp_aux_transfer()
2198 ret = -EIO; in mtk_dp_aux_transfer()
2202 switch (msg->request) { in mtk_dp_aux_transfer()
2208 request = msg->request & ~DP_AUX_I2C_WRITE_STATUS_UPDATE; in mtk_dp_aux_transfer()
2214 request = msg->request; in mtk_dp_aux_transfer()
2218 dev_err(mtk_dp->dev, "invalid aux cmd = %d\n", in mtk_dp_aux_transfer()
2219 msg->request); in mtk_dp_aux_transfer()
2220 ret = -EINVAL; in mtk_dp_aux_transfer()
2226 msg->size - accessed_bytes); in mtk_dp_aux_transfer()
2229 msg->address + accessed_bytes, in mtk_dp_aux_transfer()
2230 msg->buffer + accessed_bytes, in mtk_dp_aux_transfer()
2231 to_access, &msg->reply); in mtk_dp_aux_transfer()
2234 dev_info(mtk_dp->dev, in mtk_dp_aux_transfer()
2239 } while (accessed_bytes < msg->size); in mtk_dp_aux_transfer()
2241 return msg->size; in mtk_dp_aux_transfer()
2243 msg->reply = DP_AUX_NATIVE_REPLY_NACK | DP_AUX_I2C_REPLY_NACK; in mtk_dp_aux_transfer()
2251 ret = phy_init(mtk_dp->phy); in mtk_dp_poweron()
2253 dev_err(mtk_dp->dev, "Failed to initialize phy: %d\n", ret); in mtk_dp_poweron()
2266 phy_exit(mtk_dp->phy); in mtk_dp_poweroff()
2276 dev_err(mtk_dp->dev, "Driver does not provide a connector!"); in mtk_dp_bridge_attach()
2277 return -EINVAL; in mtk_dp_bridge_attach()
2280 mtk_dp->aux.drm_dev = bridge->dev; in mtk_dp_bridge_attach()
2281 ret = drm_dp_aux_register(&mtk_dp->aux); in mtk_dp_bridge_attach()
2283 dev_err(mtk_dp->dev, in mtk_dp_bridge_attach()
2292 if (mtk_dp->next_bridge) { in mtk_dp_bridge_attach()
2293 ret = drm_bridge_attach(bridge->encoder, mtk_dp->next_bridge, in mtk_dp_bridge_attach()
2294 &mtk_dp->bridge, flags); in mtk_dp_bridge_attach()
2296 drm_warn(mtk_dp->drm_dev, in mtk_dp_bridge_attach()
2302 mtk_dp->drm_dev = bridge->dev; in mtk_dp_bridge_attach()
2304 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP) { in mtk_dp_bridge_attach()
2305 irq_clear_status_flags(mtk_dp->irq, IRQ_NOAUTOEN); in mtk_dp_bridge_attach()
2306 enable_irq(mtk_dp->irq); in mtk_dp_bridge_attach()
2315 drm_dp_aux_unregister(&mtk_dp->aux); in mtk_dp_bridge_attach()
2323 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP) { in mtk_dp_bridge_detach()
2325 disable_irq(mtk_dp->irq); in mtk_dp_bridge_detach()
2327 mtk_dp->drm_dev = NULL; in mtk_dp_bridge_detach()
2329 drm_dp_aux_unregister(&mtk_dp->aux); in mtk_dp_bridge_detach()
2338 mtk_dp->conn = drm_atomic_get_new_connector_for_encoder(old_state->base.state, in mtk_dp_bridge_atomic_enable()
2339 bridge->encoder); in mtk_dp_bridge_atomic_enable()
2340 if (!mtk_dp->conn) { in mtk_dp_bridge_atomic_enable()
2341 drm_err(mtk_dp->drm_dev, in mtk_dp_bridge_atomic_enable()
2351 drm_err(mtk_dp->drm_dev, "Training failed, %d\n", ret); in mtk_dp_bridge_atomic_enable()
2361 mtk_dp->audio_enable = in mtk_dp_bridge_atomic_enable()
2363 &mtk_dp->info.audio_cur_cfg); in mtk_dp_bridge_atomic_enable()
2364 if (mtk_dp->audio_enable) { in mtk_dp_bridge_atomic_enable()
2365 mtk_dp_audio_setup(mtk_dp, &mtk_dp->info.audio_cur_cfg); in mtk_dp_bridge_atomic_enable()
2368 memset(&mtk_dp->info.audio_cur_cfg, 0, in mtk_dp_bridge_atomic_enable()
2369 sizeof(mtk_dp->info.audio_cur_cfg)); in mtk_dp_bridge_atomic_enable()
2372 mtk_dp->enabled = true; in mtk_dp_bridge_atomic_enable()
2387 mtk_dp->enabled = false; in mtk_dp_bridge_atomic_disable()
2392 if (mtk_dp->train_info.cable_plugged_in) { in mtk_dp_bridge_atomic_disable()
2393 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D3); in mtk_dp_bridge_atomic_disable()
2412 u32 bpp = info->color_formats & DRM_COLOR_FORMAT_YCBCR422 ? 16 : 24; in mtk_dp_bridge_mode_valid()
2413 u32 lane_count_min = mtk_dp->train_info.lane_count; in mtk_dp_bridge_mode_valid()
2414 u32 rate = drm_dp_bw_code_to_link_rate(mtk_dp->train_info.link_rate) * in mtk_dp_bridge_mode_valid()
2419 *The down-spread amplitude shall either be disabled (0.0%) or up in mtk_dp_bridge_mode_valid()
2423 *mode->clock does not need to be multiplied by 10 in mtk_dp_bridge_mode_valid()
2425 if ((rate * 97 / 100) < (mode->clock * bpp / 8)) in mtk_dp_bridge_mode_valid()
2463 struct drm_display_mode *mode = &crtc_state->adjusted_mode; in mtk_dp_bridge_atomic_get_input_bus_fmts()
2465 &conn_state->connector->display_info; in mtk_dp_bridge_atomic_get_input_bus_fmts()
2466 u32 lane_count_min = mtk_dp->train_info.lane_count; in mtk_dp_bridge_atomic_get_input_bus_fmts()
2467 u32 rate = drm_dp_bw_code_to_link_rate(mtk_dp->train_info.link_rate) * in mtk_dp_bridge_atomic_get_input_bus_fmts()
2477 if (((rate * 97 / 100) < (mode->clock * 24 / 8)) && in mtk_dp_bridge_atomic_get_input_bus_fmts()
2478 ((rate * 97 / 100) > (mode->clock * 16 / 8)) && in mtk_dp_bridge_atomic_get_input_bus_fmts()
2479 (display_info->color_formats & DRM_COLOR_FORMAT_YCBCR422)) { in mtk_dp_bridge_atomic_get_input_bus_fmts()
2505 struct drm_crtc *crtc = conn_state->crtc; in mtk_dp_bridge_atomic_check()
2508 input_bus_format = bridge_state->input_bus_cfg.format; in mtk_dp_bridge_atomic_check()
2510 dev_dbg(mtk_dp->dev, "input format 0x%04x, output format 0x%04x\n", in mtk_dp_bridge_atomic_check()
2511 bridge_state->input_bus_cfg.format, in mtk_dp_bridge_atomic_check()
2512 bridge_state->output_bus_cfg.format); in mtk_dp_bridge_atomic_check()
2515 mtk_dp->info.format = DP_PIXELFORMAT_YUV422; in mtk_dp_bridge_atomic_check()
2517 mtk_dp->info.format = DP_PIXELFORMAT_RGB; in mtk_dp_bridge_atomic_check()
2520 drm_err(mtk_dp->drm_dev, in mtk_dp_bridge_atomic_check()
2522 return -EINVAL; in mtk_dp_bridge_atomic_check()
2525 drm_display_mode_to_videomode(&crtc_state->adjusted_mode, &mtk_dp->info.vm); in mtk_dp_bridge_atomic_check()
2550 mtk_dp->need_debounce = true; in mtk_dp_debounce_timer()
2562 if (!mtk_dp->enabled) { in mtk_dp_audio_hw_params()
2563 dev_err(mtk_dp->dev, "%s, DP is not ready!\n", __func__); in mtk_dp_audio_hw_params()
2564 return -ENODEV; in mtk_dp_audio_hw_params()
2567 mtk_dp->info.audio_cur_cfg.channels = params->cea.channels; in mtk_dp_audio_hw_params()
2568 mtk_dp->info.audio_cur_cfg.sample_rate = params->sample_rate; in mtk_dp_audio_hw_params()
2570 mtk_dp_audio_setup(mtk_dp, &mtk_dp->info.audio_cur_cfg); in mtk_dp_audio_hw_params()
2596 if (mtk_dp->enabled) in mtk_dp_audio_get_eld()
2597 memcpy(buf, mtk_dp->conn->eld, len); in mtk_dp_audio_get_eld()
2610 mutex_lock(&mtk_dp->update_plugged_status_lock); in mtk_dp_audio_hook_plugged_cb()
2611 mtk_dp->plugged_cb = fn; in mtk_dp_audio_hook_plugged_cb()
2612 mtk_dp->codec_dev = codec_dev; in mtk_dp_audio_hook_plugged_cb()
2613 mutex_unlock(&mtk_dp->update_plugged_status_lock); in mtk_dp_audio_hook_plugged_cb()
2639 mtk_dp->audio_pdev = platform_device_register_data(dev, in mtk_dp_register_audio_driver()
2644 return PTR_ERR_OR_ZERO(mtk_dp->audio_pdev); in mtk_dp_register_audio_driver()
2649 struct device *dev = mtk_dp->dev; in mtk_dp_register_phy()
2651 mtk_dp->phy_dev = platform_device_register_data(dev, "mediatek-dp-phy", in mtk_dp_register_phy()
2653 &mtk_dp->regs, in mtk_dp_register_phy()
2655 if (IS_ERR(mtk_dp->phy_dev)) in mtk_dp_register_phy()
2656 return dev_err_probe(dev, PTR_ERR(mtk_dp->phy_dev), in mtk_dp_register_phy()
2657 "Failed to create device mediatek-dp-phy\n"); in mtk_dp_register_phy()
2661 mtk_dp->phy = devm_phy_get(&mtk_dp->phy_dev->dev, "dp"); in mtk_dp_register_phy()
2662 if (IS_ERR(mtk_dp->phy)) { in mtk_dp_register_phy()
2663 platform_device_unregister(mtk_dp->phy_dev); in mtk_dp_register_phy()
2664 return dev_err_probe(dev, PTR_ERR(mtk_dp->phy), "Failed to get phy\n"); in mtk_dp_register_phy()
2673 struct device *dev = mtk_aux->dev; in mtk_dp_edp_link_panel()
2676 mtk_dp->next_bridge = devm_drm_of_get_bridge(dev, dev->of_node, 1, 0); in mtk_dp_edp_link_panel()
2684 if (IS_ERR(mtk_dp->next_bridge)) { in mtk_dp_edp_link_panel()
2685 ret = PTR_ERR(mtk_dp->next_bridge); in mtk_dp_edp_link_panel()
2686 mtk_dp->next_bridge = NULL; in mtk_dp_edp_link_panel()
2691 ret = devm_drm_bridge_add(dev, &mtk_dp->bridge); in mtk_dp_edp_link_panel()
2701 struct device *dev = &pdev->dev; in mtk_dp_probe()
2706 return -ENOMEM; in mtk_dp_probe()
2708 mtk_dp->dev = dev; in mtk_dp_probe()
2709 mtk_dp->data = (struct mtk_dp_data *)of_device_get_match_data(dev); in mtk_dp_probe()
2722 if (mtk_dp->data->bridge_type != DRM_MODE_CONNECTOR_eDP) { in mtk_dp_probe()
2723 mtk_dp->irq = platform_get_irq(pdev, 0); in mtk_dp_probe()
2724 if (mtk_dp->irq < 0) in mtk_dp_probe()
2725 return dev_err_probe(dev, mtk_dp->irq, in mtk_dp_probe()
2728 spin_lock_init(&mtk_dp->irq_thread_lock); in mtk_dp_probe()
2730 irq_set_status_flags(mtk_dp->irq, IRQ_NOAUTOEN); in mtk_dp_probe()
2731 ret = devm_request_threaded_irq(dev, mtk_dp->irq, mtk_dp_hpd_event, in mtk_dp_probe()
2737 "failed to request mediatek dptx irq\n"); in mtk_dp_probe()
2739 mtk_dp->need_debounce = true; in mtk_dp_probe()
2740 timer_setup(&mtk_dp->debounce_timer, mtk_dp_debounce_timer, 0); in mtk_dp_probe()
2743 mtk_dp->aux.name = "aux_mtk_dp"; in mtk_dp_probe()
2744 mtk_dp->aux.dev = dev; in mtk_dp_probe()
2745 mtk_dp->aux.transfer = mtk_dp_aux_transfer; in mtk_dp_probe()
2746 mtk_dp->aux.wait_hpd_asserted = mtk_dp_wait_hpd_asserted; in mtk_dp_probe()
2747 drm_dp_aux_init(&mtk_dp->aux); in mtk_dp_probe()
2751 if (mtk_dp->data->audio_supported) { in mtk_dp_probe()
2752 mutex_init(&mtk_dp->update_plugged_status_lock); in mtk_dp_probe()
2764 mtk_dp->bridge.funcs = &mtk_dp_bridge_funcs; in mtk_dp_probe()
2765 mtk_dp->bridge.of_node = dev->of_node; in mtk_dp_probe()
2766 mtk_dp->bridge.type = mtk_dp->data->bridge_type; in mtk_dp_probe()
2768 if (mtk_dp->bridge.type == DRM_MODE_CONNECTOR_eDP) { in mtk_dp_probe()
2782 * Power on the AUX to allow reading the EDID from aux-bus: in mtk_dp_probe()
2791 ret = devm_of_dp_aux_populate_bus(&mtk_dp->aux, mtk_dp_edp_link_panel); in mtk_dp_probe()
2793 /* -ENODEV this means that the panel is not on the aux-bus */ in mtk_dp_probe()
2794 if (ret == -ENODEV) { in mtk_dp_probe()
2795 ret = mtk_dp_edp_link_panel(&mtk_dp->aux); in mtk_dp_probe()
2807 mtk_dp->bridge.ops = DRM_BRIDGE_OP_DETECT | in mtk_dp_probe()
2809 ret = devm_drm_bridge_add(dev, &mtk_dp->bridge); in mtk_dp_probe()
2824 pm_runtime_put(&pdev->dev); in mtk_dp_remove()
2825 pm_runtime_disable(&pdev->dev); in mtk_dp_remove()
2826 if (mtk_dp->data->bridge_type != DRM_MODE_CONNECTOR_eDP) in mtk_dp_remove()
2827 del_timer_sync(&mtk_dp->debounce_timer); in mtk_dp_remove()
2828 platform_device_unregister(mtk_dp->phy_dev); in mtk_dp_remove()
2829 if (mtk_dp->audio_pdev) in mtk_dp_remove()
2830 platform_device_unregister(mtk_dp->audio_pdev); in mtk_dp_remove()
2839 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP) in mtk_dp_suspend()
2852 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP) in mtk_dp_resume()
2889 .compatible = "mediatek,mt8188-edp-tx",
2893 .compatible = "mediatek,mt8188-dp-tx",
2897 .compatible = "mediatek,mt8195-edp-tx",
2901 .compatible = "mediatek,mt8195-dp-tx",
2912 .name = "mediatek-drm-dp",
2920 MODULE_AUTHOR("Jitao Shi <jitao.shi@mediatek.com>");
2921 MODULE_AUTHOR("Markus Schneider-Pargmann <msp@baylibre.com>");
2922 MODULE_AUTHOR("Bo-Chen Chen <rex-bc.chen@mediatek.com>");
2923 MODULE_DESCRIPTION("MediaTek DisplayPort Driver");