Lines Matching +full:ssc +full:- +full:block +full:- +full:bus
1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (c) 2019-2022 MediaTek Inc.
18 #include <linux/arm-smccc.h>
23 #include <linux/media-bus-format.h>
24 #include <linux/nvmem-consumer.h>
33 #include <sound/hdmi-codec.h>
319 .name = "mtk-dp-registers",
332 ret = regmap_read(mtk_dp->regs, offset, &read_val); in mtk_dp_read()
334 dev_err(mtk_dp->dev, "Failed to read register 0x%x: %d\n", in mtk_dp_read()
344 int ret = regmap_write(mtk_dp->regs, offset, val); in mtk_dp_write()
347 dev_err(mtk_dp->dev, in mtk_dp_write()
356 int ret = regmap_update_bits(mtk_dp->regs, offset, mask, val); in mtk_dp_update_bits()
359 dev_err(mtk_dp->dev, in mtk_dp_update_bits()
393 struct videomode *vm = &mtk_dp->info.vm; in mtk_dp_set_msa()
401 vm->hsync_len + vm->hback_porch, in mtk_dp_set_msa()
404 vm->hsync_len, HSW_SW_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
408 vm->hactive, HWIDTH_SW_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
414 vm->vsync_len + vm->vback_porch, in mtk_dp_set_msa()
417 vm->vsync_len, VSW_SW_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
421 vm->vactive, VHEIGHT_SW_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
425 vm->hactive, HDE_NUM_LAST_DP_ENC0_P0_MASK); in mtk_dp_set_msa()
429 vm->hfront_porch, in mtk_dp_set_msa()
432 vm->hsync_len, in mtk_dp_set_msa()
435 vm->hback_porch + vm->hsync_len, in mtk_dp_set_msa()
438 vm->hactive, in mtk_dp_set_msa()
446 vm->vfront_porch, in mtk_dp_set_msa()
449 vm->vsync_len, in mtk_dp_set_msa()
452 vm->vback_porch + vm->vsync_len, in mtk_dp_set_msa()
455 vm->vactive, in mtk_dp_set_msa()
477 drm_warn(mtk_dp->drm_dev, "Unsupported color format: %d\n", in mtk_dp_set_color_format()
479 return -EINVAL; in mtk_dp_set_color_format()
561 switch (cfg->channels) { in mtk_dp_audio_setup_channels()
594 switch (cfg->sample_rate) { in mtk_dp_audio_channel_status_set()
618 switch (cfg->word_length_bits) { in mtk_dp_audio_channel_status_set()
647 (min(8, channels) - 1) << 8, in mtk_dp_audio_sdp_asp_set_channels()
654 mtk_dp->data->audio_m_div2_bit, in mtk_dp_audio_set_divider()
675 u32 db_addr = MTK_DP_ENC0_P0_30D8 + (MTK_DP_SDP_AUI - 1) * 8; in mtk_dp_sdp_set_header_aui()
692 mtk_dp_sdp_set_data(mtk_dp, sdp->db); in mtk_dp_setup_sdp_aui()
693 mtk_dp_sdp_set_header_aui(mtk_dp, &sdp->sdp_header); in mtk_dp_setup_sdp_aui()
765 (length - 1) << 12, in mtk_dp_aux_set_length()
785 while (--wait_reply) { in mtk_dp_aux_wait_for_completion()
803 return -ETIMEDOUT; in mtk_dp_aux_wait_for_completion()
809 return -ETIMEDOUT; in mtk_dp_aux_wait_for_completion()
819 return -EINVAL; in mtk_dp_aux_do_transfer()
854 dev_err(mtk_dp->dev, in mtk_dp_aux_do_transfer()
856 return -EIO; in mtk_dp_aux_do_transfer()
859 return -ETIMEDOUT; in mtk_dp_aux_do_transfer()
888 dev_dbg(mtk_dp->dev, in mtk_dp_set_swing_pre_emphasis()
889 "link training: swing_val = 0x%x, pre-emphasis = 0x%x\n", in mtk_dp_set_swing_pre_emphasis()
1069 struct device *dev = mtk_dp->dev; in mtk_dp_get_calibration_data()
1071 u32 *cal_data = mtk_dp->cal_data; in mtk_dp_get_calibration_data()
1095 fmt = &mtk_dp->data->efuse_fmt[i]; in mtk_dp_get_calibration_data()
1096 cal_data[i] = (buf[fmt->idx] >> fmt->shift) & fmt->mask; in mtk_dp_get_calibration_data()
1098 if (cal_data[i] < fmt->min_val || cal_data[i] > fmt->max_val) { in mtk_dp_get_calibration_data()
1099 dev_warn(mtk_dp->dev, "Invalid efuse data, idx = %d\n", i); in mtk_dp_get_calibration_data()
1109 dev_warn(mtk_dp->dev, "Use default calibration data\n"); in mtk_dp_get_calibration_data()
1111 cal_data[i] = mtk_dp->data->efuse_fmt[i].default_val; in mtk_dp_get_calibration_data()
1116 u32 *cal_data = mtk_dp->cal_data; in mtk_dp_set_calibration_data()
1160 .ssc = mtk_dp->train_info.sink_ssc, in mtk_dp_phy_configure()
1167 ret = phy_configure(mtk_dp->phy, &phy_opts); in mtk_dp_phy_configure()
1197 pattern ? BIT(pattern - 1) << 12 : 0, in mtk_dp_train_set_pattern()
1230 mtk_dp->data->smc_cmd, enable, in mtk_dp_video_mute()
1233 dev_dbg(mtk_dp->dev, "smc cmd: 0x%x, p1: %s, ret: 0x%lx-0x%lx\n", in mtk_dp_video_mute()
1234 mtk_dp->data->smc_cmd, enable ? "enable" : "disable", res.a0, res.a1); in mtk_dp_video_mute()
1272 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D0); in mtk_dp_aux_panel_poweron()
1276 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D3); in mtk_dp_aux_panel_poweron()
1319 bool plugged_in = (mtk_dp->bridge.type == DRM_MODE_CONNECTOR_eDP); in mtk_dp_initialize_priv_data()
1321 mtk_dp->train_info.link_rate = DP_LINK_BW_5_4; in mtk_dp_initialize_priv_data()
1322 mtk_dp->train_info.lane_count = mtk_dp->max_lanes; in mtk_dp_initialize_priv_data()
1323 mtk_dp->train_info.cable_plugged_in = plugged_in; in mtk_dp_initialize_priv_data()
1325 mtk_dp->info.format = DP_PIXELFORMAT_RGB; in mtk_dp_initialize_priv_data()
1326 memset(&mtk_dp->info.vm, 0, sizeof(struct videomode)); in mtk_dp_initialize_priv_data()
1327 mtk_dp->audio_enable = false; in mtk_dp_initialize_priv_data()
1335 struct videomode *vm = &mtk_dp->info.vm; in mtk_dp_sdp_set_down_cnt_init()
1341 mtk_dp->train_info.link_rate * 2700 * 8 / in mtk_dp_sdp_set_down_cnt_init()
1344 switch (mtk_dp->train_info.lane_count) { in mtk_dp_sdp_set_down_cnt_init()
1370 struct videomode *vm = &mtk_dp->info.vm; in mtk_dp_sdp_set_down_cnt_init_in_hblank()
1374 pix_clk_mhz = mtk_dp->info.format == DP_PIXELFORMAT_YUV420 ? in mtk_dp_sdp_set_down_cnt_init_in_hblank()
1377 switch (mtk_dp->train_info.lane_count) { in mtk_dp_sdp_set_down_cnt_init_in_hblank()
1388 if (pix_clk_mhz > mtk_dp->train_info.link_rate * 27) in mtk_dp_sdp_set_down_cnt_init_in_hblank()
1402 if (!mtk_dp->data->audio_pkt_in_hblank_area) in mtk_dp_audio_sample_arrange_disable()
1414 mtk_dp->info.vm.hactive / in mtk_dp_setup_tu()
1415 mtk_dp->train_info.lane_count / in mtk_dp_setup_tu()
1456 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_LANE0_SET + lane, in mtk_dp_train_update_swing_pre()
1470 aux_offset = mtk_dp->train_info.channel_eq_pattern; in mtk_dp_pattern()
1472 switch (mtk_dp->train_info.channel_eq_pattern) { in mtk_dp_pattern()
1489 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, aux_offset); in mtk_dp_pattern()
1497 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_LINK_BW_SET, target_link_rate); in mtk_dp_train_setting()
1498 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_LANE_COUNT_SET, in mtk_dp_train_setting()
1501 if (mtk_dp->train_info.sink_ssc) in mtk_dp_train_setting()
1502 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_DOWNSPREAD_CTRL, in mtk_dp_train_setting()
1510 dev_dbg(mtk_dp->dev, in mtk_dp_train_setting()
1530 if (!mtk_dp->train_info.cable_plugged_in) { in mtk_dp_train_cr()
1532 return -ENODEV; in mtk_dp_train_cr()
1535 drm_dp_dpcd_read(&mtk_dp->aux, DP_ADJUST_REQUEST_LANE0_1, in mtk_dp_train_cr()
1540 drm_dp_link_train_clock_recovery_delay(&mtk_dp->aux, in mtk_dp_train_cr()
1541 mtk_dp->rx_cap); in mtk_dp_train_cr()
1544 drm_dp_dpcd_read_link_status(&mtk_dp->aux, link_status); in mtk_dp_train_cr()
1547 dev_dbg(mtk_dp->dev, "Link train CR pass\n"); in mtk_dp_train_cr()
1567 dev_dbg(mtk_dp->dev, "Link train CR fail\n"); in mtk_dp_train_cr()
1573 * re-calculate this retry count. in mtk_dp_train_cr()
1581 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, in mtk_dp_train_cr()
1585 return -ETIMEDOUT; in mtk_dp_train_cr()
1598 if (!mtk_dp->train_info.cable_plugged_in) { in mtk_dp_train_eq()
1600 return -ENODEV; in mtk_dp_train_eq()
1603 drm_dp_dpcd_read(&mtk_dp->aux, DP_ADJUST_REQUEST_LANE0_1, in mtk_dp_train_eq()
1608 drm_dp_link_train_channel_eq_delay(&mtk_dp->aux, in mtk_dp_train_eq()
1609 mtk_dp->rx_cap); in mtk_dp_train_eq()
1612 drm_dp_dpcd_read_link_status(&mtk_dp->aux, link_status); in mtk_dp_train_eq()
1614 dev_dbg(mtk_dp->dev, "Link train EQ pass\n"); in mtk_dp_train_eq()
1617 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, in mtk_dp_train_eq()
1622 dev_dbg(mtk_dp->dev, "Link train EQ fail\n"); in mtk_dp_train_eq()
1626 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, in mtk_dp_train_eq()
1630 return -ETIMEDOUT; in mtk_dp_train_eq()
1643 if (mtk_dp->bridge.type == DRM_MODE_CONNECTOR_eDP && in mtk_dp_parse_capabilities()
1644 mtk_dp->rx_cap[DP_MAX_LINK_RATE] && in mtk_dp_parse_capabilities()
1645 mtk_dp->train_info.sink_ssc) in mtk_dp_parse_capabilities()
1648 ret = drm_dp_read_dpcd_caps(&mtk_dp->aux, mtk_dp->rx_cap); in mtk_dp_parse_capabilities()
1652 if (drm_dp_tps4_supported(mtk_dp->rx_cap)) in mtk_dp_parse_capabilities()
1653 mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_4; in mtk_dp_parse_capabilities()
1654 else if (drm_dp_tps3_supported(mtk_dp->rx_cap)) in mtk_dp_parse_capabilities()
1655 mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_3; in mtk_dp_parse_capabilities()
1657 mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_2; in mtk_dp_parse_capabilities()
1659 mtk_dp->train_info.sink_ssc = drm_dp_max_downspread(mtk_dp->rx_cap); in mtk_dp_parse_capabilities()
1661 ret = drm_dp_dpcd_readb(&mtk_dp->aux, DP_MSTM_CAP, &val); in mtk_dp_parse_capabilities()
1663 drm_err(mtk_dp->drm_dev, "Read mstm cap failed\n"); in mtk_dp_parse_capabilities()
1664 return ret == 0 ? -EIO : ret; in mtk_dp_parse_capabilities()
1669 ret = drm_dp_dpcd_readb(&mtk_dp->aux, in mtk_dp_parse_capabilities()
1673 drm_err(mtk_dp->drm_dev, "Read irq vector failed\n"); in mtk_dp_parse_capabilities()
1674 return ret == 0 ? -EIO : ret; in mtk_dp_parse_capabilities()
1678 ret = drm_dp_dpcd_writeb(&mtk_dp->aux, in mtk_dp_parse_capabilities()
1692 if (!mtk_dp->data->audio_supported) in mtk_dp_edid_parse_audio_capabilities()
1695 if (mtk_dp->info.audio_cur_cfg.sad_count <= 0) { in mtk_dp_edid_parse_audio_capabilities()
1696 drm_info(mtk_dp->drm_dev, "The SADs is NULL\n"); in mtk_dp_edid_parse_audio_capabilities()
1705 phy_reset(mtk_dp->phy); in mtk_dp_train_change_mode()
1714 link_rate = min_t(u8, mtk_dp->max_linkrate, in mtk_dp_training()
1715 mtk_dp->rx_cap[DP_MAX_LINK_RATE]); in mtk_dp_training()
1717 lane_count = min_t(u8, mtk_dp->max_lanes, in mtk_dp_training()
1718 drm_dp_max_lane_count(mtk_dp->rx_cap)); in mtk_dp_training()
1727 for (train_limit = 6; train_limit > 0; train_limit--) { in mtk_dp_training()
1735 if (ret == -ENODEV) { in mtk_dp_training()
1744 return -EIO; in mtk_dp_training()
1756 return -EINVAL; in mtk_dp_training()
1762 if (ret == -ENODEV) { in mtk_dp_training()
1767 return -EIO; in mtk_dp_training()
1777 return -ETIMEDOUT; in mtk_dp_training()
1779 mtk_dp->train_info.link_rate = link_rate; in mtk_dp_training()
1780 mtk_dp->train_info.lane_count = lane_count; in mtk_dp_training()
1815 frame.channels = cfg->channels; in mtk_dp_audio_sdp_setup()
1816 frame.sample_frequency = cfg->sample_rate; in mtk_dp_audio_sdp_setup()
1818 switch (cfg->word_length_bits) { in mtk_dp_audio_sdp_setup()
1833 mtk_dp_audio_sdp_asp_set_channels(mtk_dp, cfg->channels); in mtk_dp_audio_sdp_setup()
1852 return mtk_dp_set_color_format(mtk_dp, mtk_dp->info.format); in mtk_dp_video_config()
1874 if (mtk_dp->need_debounce && mtk_dp->train_info.cable_plugged_in) in mtk_dp_hpd_event_thread()
1877 spin_lock_irqsave(&mtk_dp->irq_thread_lock, flags); in mtk_dp_hpd_event_thread()
1878 status = mtk_dp->irq_thread_handle; in mtk_dp_hpd_event_thread()
1879 mtk_dp->irq_thread_handle = 0; in mtk_dp_hpd_event_thread()
1880 spin_unlock_irqrestore(&mtk_dp->irq_thread_lock, flags); in mtk_dp_hpd_event_thread()
1883 if (mtk_dp->bridge.dev) in mtk_dp_hpd_event_thread()
1884 drm_helper_hpd_irq_event(mtk_dp->bridge.dev); in mtk_dp_hpd_event_thread()
1886 if (!mtk_dp->train_info.cable_plugged_in) { in mtk_dp_hpd_event_thread()
1888 memset(&mtk_dp->info.audio_cur_cfg, 0, in mtk_dp_hpd_event_thread()
1889 sizeof(mtk_dp->info.audio_cur_cfg)); in mtk_dp_hpd_event_thread()
1891 mtk_dp->need_debounce = false; in mtk_dp_hpd_event_thread()
1892 mod_timer(&mtk_dp->debounce_timer, in mtk_dp_hpd_event_thread()
1893 jiffies + msecs_to_jiffies(100) - 1); in mtk_dp_hpd_event_thread()
1898 dev_dbg(mtk_dp->dev, "Receive IRQ from sink devices\n"); in mtk_dp_hpd_event_thread()
1914 spin_lock_irqsave(&mtk_dp->irq_thread_lock, flags); in mtk_dp_hpd_event()
1917 mtk_dp->irq_thread_handle |= MTK_DP_THREAD_HPD_EVENT; in mtk_dp_hpd_event()
1921 mtk_dp->irq_thread_handle |= MTK_DP_THREAD_CABLE_STATE_CHG; in mtk_dp_hpd_event()
1925 spin_unlock_irqrestore(&mtk_dp->irq_thread_lock, flags); in mtk_dp_hpd_event()
1930 mtk_dp->train_info.cable_plugged_in = true; in mtk_dp_hpd_event()
1932 mtk_dp->train_info.cable_plugged_in = false; in mtk_dp_hpd_event()
1944 ret = regmap_read_poll_timeout(mtk_dp->regs, MTK_DP_TRANS_P0_3414, in mtk_dp_wait_hpd_asserted()
1948 mtk_dp->train_info.cable_plugged_in = false; in mtk_dp_wait_hpd_asserted()
1952 mtk_dp->train_info.cable_plugged_in = true; in mtk_dp_wait_hpd_asserted()
1956 drm_err(mtk_dp->drm_dev, "Can't parse capabilities\n"); in mtk_dp_wait_hpd_asserted()
1967 struct device *dev = &pdev->dev; in mtk_dp_dt_parse()
1977 mtk_dp->regs = devm_regmap_init_mmio(dev, base, &mtk_dp_regmap_config); in mtk_dp_dt_parse()
1978 if (IS_ERR(mtk_dp->regs)) in mtk_dp_dt_parse()
1979 return PTR_ERR(mtk_dp->regs); in mtk_dp_dt_parse()
1981 endpoint = of_graph_get_endpoint_by_regs(pdev->dev.of_node, 1, -1); in mtk_dp_dt_parse()
1983 "data-lanes", sizeof(u32)); in mtk_dp_dt_parse()
1986 return -EINVAL; in mtk_dp_dt_parse()
1989 mtk_dp->max_lanes = len; in mtk_dp_dt_parse()
1991 ret = device_property_read_u32(dev, "max-linkrate-mhz", &linkrate); in mtk_dp_dt_parse()
1997 mtk_dp->max_linkrate = drm_dp_link_rate_to_bw_code(linkrate * 100); in mtk_dp_dt_parse()
2004 if (!mtk_dp->data->audio_supported || !mtk_dp->audio_enable) in mtk_dp_update_plugged_status()
2007 mutex_lock(&mtk_dp->update_plugged_status_lock); in mtk_dp_update_plugged_status()
2008 if (mtk_dp->plugged_cb && mtk_dp->codec_dev) in mtk_dp_update_plugged_status()
2009 mtk_dp->plugged_cb(mtk_dp->codec_dev, in mtk_dp_update_plugged_status()
2010 mtk_dp->enabled & in mtk_dp_update_plugged_status()
2011 mtk_dp->info.audio_cur_cfg.detect_monitor); in mtk_dp_update_plugged_status()
2012 mutex_unlock(&mtk_dp->update_plugged_status_lock); in mtk_dp_update_plugged_status()
2019 bool enabled = mtk_dp->enabled; in mtk_dp_bdg_detect()
2022 if (!mtk_dp->train_info.cable_plugged_in) in mtk_dp_bdg_detect()
2035 drm_dp_dpcd_readb(&mtk_dp->aux, DP_SINK_COUNT, &sink_count); in mtk_dp_bdg_detect()
2049 bool enabled = mtk_dp->enabled; in mtk_dp_get_edid()
2051 struct mtk_dp_audio_cfg *audio_caps = &mtk_dp->info.audio_cur_cfg; in mtk_dp_get_edid()
2054 drm_atomic_bridge_chain_pre_enable(bridge, connector->state->state); in mtk_dp_get_edid()
2058 new_edid = drm_get_edid(connector, &mtk_dp->aux.ddc); in mtk_dp_get_edid()
2065 drm_err(mtk_dp->drm_dev, "Can't parse capabilities\n"); in mtk_dp_get_edid()
2073 audio_caps->sad_count = drm_edid_to_sad(new_edid, &sads); in mtk_dp_get_edid()
2076 audio_caps->detect_monitor = drm_detect_monitor_audio(new_edid); in mtk_dp_get_edid()
2081 drm_atomic_bridge_chain_post_disable(bridge, connector->state->state); in mtk_dp_get_edid()
2096 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP && in mtk_dp_aux_transfer()
2097 !mtk_dp->train_info.cable_plugged_in) { in mtk_dp_aux_transfer()
2098 ret = -EAGAIN; in mtk_dp_aux_transfer()
2102 switch (msg->request) { in mtk_dp_aux_transfer()
2108 request = msg->request & ~DP_AUX_I2C_WRITE_STATUS_UPDATE; in mtk_dp_aux_transfer()
2114 request = msg->request; in mtk_dp_aux_transfer()
2118 dev_err(mtk_dp->dev, "invalid aux cmd = %d\n", in mtk_dp_aux_transfer()
2119 msg->request); in mtk_dp_aux_transfer()
2120 ret = -EINVAL; in mtk_dp_aux_transfer()
2126 msg->size - accessed_bytes); in mtk_dp_aux_transfer()
2129 msg->address + accessed_bytes, in mtk_dp_aux_transfer()
2130 msg->buffer + accessed_bytes, in mtk_dp_aux_transfer()
2131 to_access, &msg->reply); in mtk_dp_aux_transfer()
2134 dev_info(mtk_dp->dev, in mtk_dp_aux_transfer()
2139 } while (accessed_bytes < msg->size); in mtk_dp_aux_transfer()
2141 return msg->size; in mtk_dp_aux_transfer()
2143 msg->reply = DP_AUX_NATIVE_REPLY_NACK | DP_AUX_I2C_REPLY_NACK; in mtk_dp_aux_transfer()
2151 ret = phy_init(mtk_dp->phy); in mtk_dp_poweron()
2153 dev_err(mtk_dp->dev, "Failed to initialize phy: %d\n", ret); in mtk_dp_poweron()
2166 phy_exit(mtk_dp->phy); in mtk_dp_poweroff()
2176 dev_err(mtk_dp->dev, "Driver does not provide a connector!"); in mtk_dp_bridge_attach()
2177 return -EINVAL; in mtk_dp_bridge_attach()
2180 mtk_dp->aux.drm_dev = bridge->dev; in mtk_dp_bridge_attach()
2181 ret = drm_dp_aux_register(&mtk_dp->aux); in mtk_dp_bridge_attach()
2183 dev_err(mtk_dp->dev, in mtk_dp_bridge_attach()
2192 if (mtk_dp->next_bridge) { in mtk_dp_bridge_attach()
2193 ret = drm_bridge_attach(bridge->encoder, mtk_dp->next_bridge, in mtk_dp_bridge_attach()
2194 &mtk_dp->bridge, flags); in mtk_dp_bridge_attach()
2196 drm_warn(mtk_dp->drm_dev, in mtk_dp_bridge_attach()
2202 mtk_dp->drm_dev = bridge->dev; in mtk_dp_bridge_attach()
2204 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP) { in mtk_dp_bridge_attach()
2205 irq_clear_status_flags(mtk_dp->irq, IRQ_NOAUTOEN); in mtk_dp_bridge_attach()
2206 enable_irq(mtk_dp->irq); in mtk_dp_bridge_attach()
2215 drm_dp_aux_unregister(&mtk_dp->aux); in mtk_dp_bridge_attach()
2223 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP) { in mtk_dp_bridge_detach()
2225 disable_irq(mtk_dp->irq); in mtk_dp_bridge_detach()
2227 mtk_dp->drm_dev = NULL; in mtk_dp_bridge_detach()
2229 drm_dp_aux_unregister(&mtk_dp->aux); in mtk_dp_bridge_detach()
2238 mtk_dp->conn = drm_atomic_get_new_connector_for_encoder(old_state->base.state, in mtk_dp_bridge_atomic_enable()
2239 bridge->encoder); in mtk_dp_bridge_atomic_enable()
2240 if (!mtk_dp->conn) { in mtk_dp_bridge_atomic_enable()
2241 drm_err(mtk_dp->drm_dev, in mtk_dp_bridge_atomic_enable()
2251 drm_err(mtk_dp->drm_dev, "Training failed, %d\n", ret); in mtk_dp_bridge_atomic_enable()
2261 mtk_dp->audio_enable = in mtk_dp_bridge_atomic_enable()
2263 &mtk_dp->info.audio_cur_cfg); in mtk_dp_bridge_atomic_enable()
2264 if (mtk_dp->audio_enable) { in mtk_dp_bridge_atomic_enable()
2265 mtk_dp_audio_setup(mtk_dp, &mtk_dp->info.audio_cur_cfg); in mtk_dp_bridge_atomic_enable()
2268 memset(&mtk_dp->info.audio_cur_cfg, 0, in mtk_dp_bridge_atomic_enable()
2269 sizeof(mtk_dp->info.audio_cur_cfg)); in mtk_dp_bridge_atomic_enable()
2272 mtk_dp->enabled = true; in mtk_dp_bridge_atomic_enable()
2287 mtk_dp->enabled = false; in mtk_dp_bridge_atomic_disable()
2292 if (mtk_dp->train_info.cable_plugged_in) { in mtk_dp_bridge_atomic_disable()
2293 drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D3); in mtk_dp_bridge_atomic_disable()
2312 u32 bpp = info->color_formats & DRM_COLOR_FORMAT_YCBCR422 ? 16 : 24; in mtk_dp_bridge_mode_valid()
2313 u32 rate = min_t(u32, drm_dp_max_link_rate(mtk_dp->rx_cap) * in mtk_dp_bridge_mode_valid()
2314 drm_dp_max_lane_count(mtk_dp->rx_cap), in mtk_dp_bridge_mode_valid()
2315 drm_dp_bw_code_to_link_rate(mtk_dp->max_linkrate) * in mtk_dp_bridge_mode_valid()
2316 mtk_dp->max_lanes); in mtk_dp_bridge_mode_valid()
2318 if (rate < mode->clock * bpp / 8) in mtk_dp_bridge_mode_valid()
2356 struct drm_display_mode *mode = &crtc_state->adjusted_mode; in mtk_dp_bridge_atomic_get_input_bus_fmts()
2358 &conn_state->connector->display_info; in mtk_dp_bridge_atomic_get_input_bus_fmts()
2359 u32 rate = min_t(u32, drm_dp_max_link_rate(mtk_dp->rx_cap) * in mtk_dp_bridge_atomic_get_input_bus_fmts()
2360 drm_dp_max_lane_count(mtk_dp->rx_cap), in mtk_dp_bridge_atomic_get_input_bus_fmts()
2361 drm_dp_bw_code_to_link_rate(mtk_dp->max_linkrate) * in mtk_dp_bridge_atomic_get_input_bus_fmts()
2362 mtk_dp->max_lanes); in mtk_dp_bridge_atomic_get_input_bus_fmts()
2371 if ((rate < (mode->clock * 24 / 8)) && in mtk_dp_bridge_atomic_get_input_bus_fmts()
2372 (rate > (mode->clock * 16 / 8)) && in mtk_dp_bridge_atomic_get_input_bus_fmts()
2373 (display_info->color_formats & DRM_COLOR_FORMAT_YCBCR422)) { in mtk_dp_bridge_atomic_get_input_bus_fmts()
2399 struct drm_crtc *crtc = conn_state->crtc; in mtk_dp_bridge_atomic_check()
2402 input_bus_format = bridge_state->input_bus_cfg.format; in mtk_dp_bridge_atomic_check()
2404 dev_dbg(mtk_dp->dev, "input format 0x%04x, output format 0x%04x\n", in mtk_dp_bridge_atomic_check()
2405 bridge_state->input_bus_cfg.format, in mtk_dp_bridge_atomic_check()
2406 bridge_state->output_bus_cfg.format); in mtk_dp_bridge_atomic_check()
2409 mtk_dp->info.format = DP_PIXELFORMAT_YUV422; in mtk_dp_bridge_atomic_check()
2411 mtk_dp->info.format = DP_PIXELFORMAT_RGB; in mtk_dp_bridge_atomic_check()
2414 drm_err(mtk_dp->drm_dev, in mtk_dp_bridge_atomic_check()
2416 return -EINVAL; in mtk_dp_bridge_atomic_check()
2419 drm_display_mode_to_videomode(&crtc_state->adjusted_mode, &mtk_dp->info.vm); in mtk_dp_bridge_atomic_check()
2444 mtk_dp->need_debounce = true; in mtk_dp_debounce_timer()
2456 if (!mtk_dp->enabled) { in mtk_dp_audio_hw_params()
2457 dev_err(mtk_dp->dev, "%s, DP is not ready!\n", __func__); in mtk_dp_audio_hw_params()
2458 return -ENODEV; in mtk_dp_audio_hw_params()
2461 mtk_dp->info.audio_cur_cfg.channels = params->cea.channels; in mtk_dp_audio_hw_params()
2462 mtk_dp->info.audio_cur_cfg.sample_rate = params->sample_rate; in mtk_dp_audio_hw_params()
2464 mtk_dp_audio_setup(mtk_dp, &mtk_dp->info.audio_cur_cfg); in mtk_dp_audio_hw_params()
2490 if (mtk_dp->enabled) in mtk_dp_audio_get_eld()
2491 memcpy(buf, mtk_dp->conn->eld, len); in mtk_dp_audio_get_eld()
2504 mutex_lock(&mtk_dp->update_plugged_status_lock); in mtk_dp_audio_hook_plugged_cb()
2505 mtk_dp->plugged_cb = fn; in mtk_dp_audio_hook_plugged_cb()
2506 mtk_dp->codec_dev = codec_dev; in mtk_dp_audio_hook_plugged_cb()
2507 mutex_unlock(&mtk_dp->update_plugged_status_lock); in mtk_dp_audio_hook_plugged_cb()
2533 mtk_dp->audio_pdev = platform_device_register_data(dev, in mtk_dp_register_audio_driver()
2538 return PTR_ERR_OR_ZERO(mtk_dp->audio_pdev); in mtk_dp_register_audio_driver()
2543 struct device *dev = mtk_dp->dev; in mtk_dp_register_phy()
2545 mtk_dp->phy_dev = platform_device_register_data(dev, "mediatek-dp-phy", in mtk_dp_register_phy()
2547 &mtk_dp->regs, in mtk_dp_register_phy()
2549 if (IS_ERR(mtk_dp->phy_dev)) in mtk_dp_register_phy()
2550 return dev_err_probe(dev, PTR_ERR(mtk_dp->phy_dev), in mtk_dp_register_phy()
2551 "Failed to create device mediatek-dp-phy\n"); in mtk_dp_register_phy()
2555 mtk_dp->phy = devm_phy_get(&mtk_dp->phy_dev->dev, "dp"); in mtk_dp_register_phy()
2556 if (IS_ERR(mtk_dp->phy)) { in mtk_dp_register_phy()
2557 platform_device_unregister(mtk_dp->phy_dev); in mtk_dp_register_phy()
2558 return dev_err_probe(dev, PTR_ERR(mtk_dp->phy), "Failed to get phy\n"); in mtk_dp_register_phy()
2567 struct device *dev = mtk_aux->dev; in mtk_dp_edp_link_panel()
2570 mtk_dp->next_bridge = devm_drm_of_get_bridge(dev, dev->of_node, 1, 0); in mtk_dp_edp_link_panel()
2578 if (IS_ERR(mtk_dp->next_bridge)) { in mtk_dp_edp_link_panel()
2579 ret = PTR_ERR(mtk_dp->next_bridge); in mtk_dp_edp_link_panel()
2580 mtk_dp->next_bridge = NULL; in mtk_dp_edp_link_panel()
2585 ret = devm_drm_bridge_add(dev, &mtk_dp->bridge); in mtk_dp_edp_link_panel()
2595 struct device *dev = &pdev->dev; in mtk_dp_probe()
2600 return -ENOMEM; in mtk_dp_probe()
2602 mtk_dp->dev = dev; in mtk_dp_probe()
2603 mtk_dp->data = (struct mtk_dp_data *)of_device_get_match_data(dev); in mtk_dp_probe()
2616 if (mtk_dp->data->bridge_type != DRM_MODE_CONNECTOR_eDP) { in mtk_dp_probe()
2617 mtk_dp->irq = platform_get_irq(pdev, 0); in mtk_dp_probe()
2618 if (mtk_dp->irq < 0) in mtk_dp_probe()
2619 return dev_err_probe(dev, mtk_dp->irq, in mtk_dp_probe()
2622 spin_lock_init(&mtk_dp->irq_thread_lock); in mtk_dp_probe()
2624 irq_set_status_flags(mtk_dp->irq, IRQ_NOAUTOEN); in mtk_dp_probe()
2625 ret = devm_request_threaded_irq(dev, mtk_dp->irq, mtk_dp_hpd_event, in mtk_dp_probe()
2633 mtk_dp->need_debounce = true; in mtk_dp_probe()
2634 timer_setup(&mtk_dp->debounce_timer, mtk_dp_debounce_timer, 0); in mtk_dp_probe()
2637 mtk_dp->aux.name = "aux_mtk_dp"; in mtk_dp_probe()
2638 mtk_dp->aux.dev = dev; in mtk_dp_probe()
2639 mtk_dp->aux.transfer = mtk_dp_aux_transfer; in mtk_dp_probe()
2640 mtk_dp->aux.wait_hpd_asserted = mtk_dp_wait_hpd_asserted; in mtk_dp_probe()
2641 drm_dp_aux_init(&mtk_dp->aux); in mtk_dp_probe()
2645 if (mtk_dp->data->audio_supported) { in mtk_dp_probe()
2646 mutex_init(&mtk_dp->update_plugged_status_lock); in mtk_dp_probe()
2660 mtk_dp->bridge.funcs = &mtk_dp_bridge_funcs; in mtk_dp_probe()
2661 mtk_dp->bridge.of_node = dev->of_node; in mtk_dp_probe()
2662 mtk_dp->bridge.type = mtk_dp->data->bridge_type; in mtk_dp_probe()
2664 if (mtk_dp->bridge.type == DRM_MODE_CONNECTOR_eDP) { in mtk_dp_probe()
2668 * reinitialize, reset and power on the AUX block. in mtk_dp_probe()
2678 * Power on the AUX to allow reading the EDID from aux-bus: in mtk_dp_probe()
2687 ret = devm_of_dp_aux_populate_bus(&mtk_dp->aux, mtk_dp_edp_link_panel); in mtk_dp_probe()
2689 /* -ENODEV this means that the panel is not on the aux-bus */ in mtk_dp_probe()
2690 if (ret == -ENODEV) { in mtk_dp_probe()
2691 ret = mtk_dp_edp_link_panel(&mtk_dp->aux); in mtk_dp_probe()
2703 mtk_dp->bridge.ops = DRM_BRIDGE_OP_DETECT | in mtk_dp_probe()
2705 ret = devm_drm_bridge_add(dev, &mtk_dp->bridge); in mtk_dp_probe()
2720 pm_runtime_put(&pdev->dev); in mtk_dp_remove()
2721 pm_runtime_disable(&pdev->dev); in mtk_dp_remove()
2722 if (mtk_dp->data->bridge_type != DRM_MODE_CONNECTOR_eDP) in mtk_dp_remove()
2723 del_timer_sync(&mtk_dp->debounce_timer); in mtk_dp_remove()
2724 platform_device_unregister(mtk_dp->phy_dev); in mtk_dp_remove()
2725 if (mtk_dp->audio_pdev) in mtk_dp_remove()
2726 platform_device_unregister(mtk_dp->audio_pdev); in mtk_dp_remove()
2735 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP) in mtk_dp_suspend()
2748 if (mtk_dp->bridge.type != DRM_MODE_CONNECTOR_eDP) in mtk_dp_resume()
2785 .compatible = "mediatek,mt8188-edp-tx",
2789 .compatible = "mediatek,mt8188-dp-tx",
2793 .compatible = "mediatek,mt8195-edp-tx",
2797 .compatible = "mediatek,mt8195-dp-tx",
2808 .name = "mediatek-drm-dp",
2817 MODULE_AUTHOR("Markus Schneider-Pargmann <msp@baylibre.com>");
2818 MODULE_AUTHOR("Bo-Chen Chen <rex-bc.chen@mediatek.com>");