Lines Matching refs:hdmi
12 #include <linux/hdmi.h>
38 #include "dw-hdmi-audio.h"
39 #include "dw-hdmi-cec.h"
40 #include "dw-hdmi.h"
125 int (*configure)(struct dw_hdmi *hdmi,
191 void (*enable_audio)(struct dw_hdmi *hdmi);
192 void (*disable_audio)(struct dw_hdmi *hdmi);
210 static inline void hdmi_writeb(struct dw_hdmi *hdmi, u8 val, int offset)
212 regmap_write(hdmi->regm, offset << hdmi->reg_shift, val);
215 static inline u8 hdmi_readb(struct dw_hdmi *hdmi, int offset)
219 regmap_read(hdmi->regm, offset << hdmi->reg_shift, &val);
224 static void handle_plugged_change(struct dw_hdmi *hdmi, bool plugged)
226 if (hdmi->plugged_cb && hdmi->codec_dev)
227 hdmi->plugged_cb(hdmi->codec_dev, plugged);
230 int dw_hdmi_set_plugged_cb(struct dw_hdmi *hdmi, hdmi_codec_plugged_cb fn,
235 mutex_lock(&hdmi->mutex);
236 hdmi->plugged_cb = fn;
237 hdmi->codec_dev = codec_dev;
238 plugged = hdmi->last_connector_result == connector_status_connected;
239 handle_plugged_change(hdmi, plugged);
240 mutex_unlock(&hdmi->mutex);
246 static void hdmi_modb(struct dw_hdmi *hdmi, u8 data, u8 mask, unsigned reg)
248 regmap_update_bits(hdmi->regm, reg << hdmi->reg_shift, mask, data);
251 static void hdmi_mask_writeb(struct dw_hdmi *hdmi, u8 data, unsigned int reg,
254 hdmi_modb(hdmi, data << shift, mask, reg);
257 static void dw_hdmi_i2c_init(struct dw_hdmi *hdmi)
259 hdmi_writeb(hdmi, HDMI_PHY_I2CM_INT_ADDR_DONE_POL,
262 hdmi_writeb(hdmi, HDMI_PHY_I2CM_CTLINT_ADDR_NAC_POL |
267 hdmi_writeb(hdmi, 0x00, HDMI_I2CM_SOFTRSTZ);
270 hdmi_writeb(hdmi, 0x00, HDMI_I2CM_DIV);
273 hdmi_writeb(hdmi, HDMI_I2CM_INT_DONE_POL, HDMI_I2CM_INT);
274 hdmi_writeb(hdmi, HDMI_I2CM_CTLINT_NAC_POL | HDMI_I2CM_CTLINT_ARB_POL,
278 hdmi_writeb(hdmi, HDMI_IH_I2CM_STAT0_ERROR | HDMI_IH_I2CM_STAT0_DONE,
282 hdmi_writeb(hdmi, HDMI_IH_I2CM_STAT0_ERROR | HDMI_IH_I2CM_STAT0_DONE,
286 static bool dw_hdmi_i2c_unwedge(struct dw_hdmi *hdmi)
289 if (!hdmi->unwedge_state)
292 dev_info(hdmi->dev, "Attempting to unwedge stuck i2c bus\n");
326 pinctrl_select_state(hdmi->pinctrl, hdmi->unwedge_state);
328 pinctrl_select_state(hdmi->pinctrl, hdmi->default_state);
333 static int dw_hdmi_i2c_wait(struct dw_hdmi *hdmi)
335 struct dw_hdmi_i2c *i2c = hdmi->i2c;
341 if (!dw_hdmi_i2c_unwedge(hdmi))
357 static int dw_hdmi_i2c_read(struct dw_hdmi *hdmi,
360 struct dw_hdmi_i2c *i2c = hdmi->i2c;
364 dev_dbg(hdmi->dev, "set read register address to 0\n");
372 hdmi_writeb(hdmi, i2c->slave_reg++, HDMI_I2CM_ADDRESS);
374 hdmi_writeb(hdmi, HDMI_I2CM_OPERATION_READ_EXT,
377 hdmi_writeb(hdmi, HDMI_I2CM_OPERATION_READ,
380 ret = dw_hdmi_i2c_wait(hdmi);
384 *buf++ = hdmi_readb(hdmi, HDMI_I2CM_DATAI);
391 static int dw_hdmi_i2c_write(struct dw_hdmi *hdmi,
394 struct dw_hdmi_i2c *i2c = hdmi->i2c;
408 hdmi_writeb(hdmi, *buf++, HDMI_I2CM_DATAO);
409 hdmi_writeb(hdmi, i2c->slave_reg++, HDMI_I2CM_ADDRESS);
410 hdmi_writeb(hdmi, HDMI_I2CM_OPERATION_WRITE,
413 ret = dw_hdmi_i2c_wait(hdmi);
424 struct dw_hdmi *hdmi = i2c_get_adapdata(adap);
425 struct dw_hdmi_i2c *i2c = hdmi->i2c;
438 dev_dbg(hdmi->dev, "xfer: num: %d, addr: %#x\n", num, addr);
442 dev_dbg(hdmi->dev,
452 hdmi_writeb(hdmi, 0x00, HDMI_IH_MUTE_I2CM_STAT0);
455 hdmi_writeb(hdmi, addr, HDMI_I2CM_SLAVE);
464 dev_dbg(hdmi->dev, "xfer: num: %d/%d, len: %d, flags: %#x\n",
468 hdmi_writeb(hdmi, DDC_SEGMENT_ADDR, HDMI_I2CM_SEGADDR);
469 hdmi_writeb(hdmi, *msgs[i].buf, HDMI_I2CM_SEGPTR);
472 ret = dw_hdmi_i2c_read(hdmi, msgs[i].buf,
475 ret = dw_hdmi_i2c_write(hdmi, msgs[i].buf,
486 hdmi_writeb(hdmi, HDMI_IH_I2CM_STAT0_ERROR | HDMI_IH_I2CM_STAT0_DONE,
504 static struct i2c_adapter *dw_hdmi_i2c_adapter(struct dw_hdmi *hdmi)
510 i2c = devm_kzalloc(hdmi->dev, sizeof(*i2c), GFP_KERNEL);
520 adap->dev.parent = hdmi->dev;
523 i2c_set_adapdata(adap, hdmi);
527 dev_warn(hdmi->dev, "cannot add %s I2C adapter\n", adap->name);
528 devm_kfree(hdmi->dev, i2c);
532 hdmi->i2c = i2c;
534 dev_info(hdmi->dev, "registered %s I2C bus driver\n", adap->name);
539 static void hdmi_set_cts_n(struct dw_hdmi *hdmi, unsigned int cts,
543 hdmi_modb(hdmi, 0, HDMI_AUD_CTS3_CTS_MANUAL, HDMI_AUD_CTS3);
546 hdmi_modb(hdmi, 0, HDMI_AUD_CTS3_N_SHIFT_MASK, HDMI_AUD_CTS3);
550 hdmi_writeb(hdmi, ((cts >> 16) &
555 hdmi_writeb(hdmi, 0, HDMI_AUD_CTS3);
556 hdmi_writeb(hdmi, (cts >> 8) & 0xff, HDMI_AUD_CTS2);
557 hdmi_writeb(hdmi, cts & 0xff, HDMI_AUD_CTS1);
559 hdmi_writeb(hdmi, (n >> 16) & 0x0f, HDMI_AUD_N3);
560 hdmi_writeb(hdmi, (n >> 8) & 0xff, HDMI_AUD_N2);
561 hdmi_writeb(hdmi, n & 0xff, HDMI_AUD_N1);
634 void dw_hdmi_set_channel_status(struct dw_hdmi *hdmi,
641 hdmi_writeb(hdmi, channel_status[3], HDMI_FC_AUDSCHNLS7);
642 hdmi_writeb(hdmi, channel_status[4], HDMI_FC_AUDSCHNLS8);
646 static void hdmi_set_clk_regenerator(struct dw_hdmi *hdmi,
656 config3 = hdmi_readb(hdmi, HDMI_CONFIG3_ID);
671 dev_dbg(hdmi->dev, "%s: fs=%uHz ftdms=%lu.%03luMHz N=%d cts=%d\n",
679 spin_lock_irq(&hdmi->audio_lock);
680 hdmi->audio_n = n;
681 hdmi->audio_cts = cts;
682 hdmi_set_cts_n(hdmi, cts, hdmi->audio_enable ? n : 0);
683 spin_unlock_irq(&hdmi->audio_lock);
686 static void hdmi_init_clk_regenerator(struct dw_hdmi *hdmi)
688 mutex_lock(&hdmi->audio_mutex);
689 hdmi_set_clk_regenerator(hdmi, 74250000, hdmi->sample_rate);
690 mutex_unlock(&hdmi->audio_mutex);
693 static void hdmi_clk_regenerator_update_pixel_clock(struct dw_hdmi *hdmi)
695 mutex_lock(&hdmi->audio_mutex);
696 hdmi_set_clk_regenerator(hdmi, hdmi->hdmi_data.video_mode.mtmdsclock,
697 hdmi->sample_rate);
698 mutex_unlock(&hdmi->audio_mutex);
701 void dw_hdmi_set_sample_width(struct dw_hdmi *hdmi, unsigned int width)
703 mutex_lock(&hdmi->audio_mutex);
704 hdmi->sample_width = width;
705 mutex_unlock(&hdmi->audio_mutex);
709 void dw_hdmi_set_sample_non_pcm(struct dw_hdmi *hdmi, unsigned int non_pcm)
711 mutex_lock(&hdmi->audio_mutex);
712 hdmi->sample_non_pcm = non_pcm;
713 mutex_unlock(&hdmi->audio_mutex);
717 void dw_hdmi_set_sample_rate(struct dw_hdmi *hdmi, unsigned int rate)
719 mutex_lock(&hdmi->audio_mutex);
720 hdmi->sample_rate = rate;
721 hdmi_set_clk_regenerator(hdmi, hdmi->hdmi_data.video_mode.mtmdsclock,
722 hdmi->sample_rate);
723 mutex_unlock(&hdmi->audio_mutex);
727 void dw_hdmi_set_channel_count(struct dw_hdmi *hdmi, unsigned int cnt)
731 mutex_lock(&hdmi->audio_mutex);
732 hdmi->channels = cnt;
743 hdmi_modb(hdmi, layout, HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_MASK,
747 hdmi_modb(hdmi, (cnt - 1) << HDMI_FC_AUDICONF0_CC_OFFSET,
750 mutex_unlock(&hdmi->audio_mutex);
754 void dw_hdmi_set_channel_allocation(struct dw_hdmi *hdmi, unsigned int ca)
756 mutex_lock(&hdmi->audio_mutex);
758 hdmi_writeb(hdmi, ca, HDMI_FC_AUDICONF2);
760 mutex_unlock(&hdmi->audio_mutex);
764 static void hdmi_enable_audio_clk(struct dw_hdmi *hdmi, bool enable)
767 hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_AUDCLK_DISABLE;
769 hdmi->mc_clkdis |= HDMI_MC_CLKDIS_AUDCLK_DISABLE;
770 hdmi_writeb(hdmi, hdmi->mc_clkdis, HDMI_MC_CLKDIS);
773 static u8 *hdmi_audio_get_eld(struct dw_hdmi *hdmi)
775 if (!hdmi->curr_conn)
778 return hdmi->curr_conn->eld;
781 static void dw_hdmi_gp_audio_enable(struct dw_hdmi *hdmi)
783 const struct dw_hdmi_plat_data *pdata = hdmi->plat_data;
785 int ch_mask = BIT(hdmi->channels) - 1;
787 switch (hdmi->sample_rate) {
820 hdmi_set_cts_n(hdmi, hdmi->audio_cts, hdmi->audio_n);
821 hdmi_enable_audio_clk(hdmi, true);
823 hdmi_writeb(hdmi, 0x1, HDMI_FC_AUDSCHNLS0);
824 hdmi_writeb(hdmi, hdmi->channels, HDMI_FC_AUDSCHNLS2);
825 hdmi_writeb(hdmi, 0x22, HDMI_FC_AUDSCHNLS3);
826 hdmi_writeb(hdmi, 0x22, HDMI_FC_AUDSCHNLS4);
827 hdmi_writeb(hdmi, 0x11, HDMI_FC_AUDSCHNLS5);
828 hdmi_writeb(hdmi, 0x11, HDMI_FC_AUDSCHNLS6);
829 hdmi_writeb(hdmi, (0x3 << 4) | sample_freq, HDMI_FC_AUDSCHNLS7);
830 hdmi_writeb(hdmi, (org_sample_freq << 4) | 0xb, HDMI_FC_AUDSCHNLS8);
832 hdmi_writeb(hdmi, ch_mask, HDMI_GP_CONF1);
833 hdmi_writeb(hdmi, 0x02, HDMI_GP_CONF2);
834 hdmi_writeb(hdmi, 0x01, HDMI_GP_CONF0);
836 hdmi_modb(hdmi, 0x3, 0x3, HDMI_FC_DATAUTO3);
839 if (hdmi->sample_rate == 192000 && hdmi->channels == 8 &&
840 hdmi->sample_width == 32 && hdmi->sample_non_pcm)
841 hdmi_modb(hdmi, 0x01, 0x01, HDMI_GP_CONF2);
844 pdata->enable_audio(hdmi,
845 hdmi->channels,
846 hdmi->sample_width,
847 hdmi->sample_rate,
848 hdmi->sample_non_pcm);
851 static void dw_hdmi_gp_audio_disable(struct dw_hdmi *hdmi)
853 const struct dw_hdmi_plat_data *pdata = hdmi->plat_data;
855 hdmi_set_cts_n(hdmi, hdmi->audio_cts, 0);
857 hdmi_modb(hdmi, 0, 0x3, HDMI_FC_DATAUTO3);
859 pdata->disable_audio(hdmi);
861 hdmi_enable_audio_clk(hdmi, false);
864 static void dw_hdmi_ahb_audio_enable(struct dw_hdmi *hdmi)
866 hdmi_set_cts_n(hdmi, hdmi->audio_cts, hdmi->audio_n);
869 static void dw_hdmi_ahb_audio_disable(struct dw_hdmi *hdmi)
871 hdmi_set_cts_n(hdmi, hdmi->audio_cts, 0);
874 static void dw_hdmi_i2s_audio_enable(struct dw_hdmi *hdmi)
876 hdmi_set_cts_n(hdmi, hdmi->audio_cts, hdmi->audio_n);
877 hdmi_enable_audio_clk(hdmi, true);
880 static void dw_hdmi_i2s_audio_disable(struct dw_hdmi *hdmi)
882 hdmi_enable_audio_clk(hdmi, false);
885 void dw_hdmi_audio_enable(struct dw_hdmi *hdmi)
889 spin_lock_irqsave(&hdmi->audio_lock, flags);
890 hdmi->audio_enable = true;
891 if (hdmi->enable_audio)
892 hdmi->enable_audio(hdmi);
893 spin_unlock_irqrestore(&hdmi->audio_lock, flags);
897 void dw_hdmi_audio_disable(struct dw_hdmi *hdmi)
901 spin_lock_irqsave(&hdmi->audio_lock, flags);
902 hdmi->audio_enable = false;
903 if (hdmi->disable_audio)
904 hdmi->disable_audio(hdmi);
905 spin_unlock_irqrestore(&hdmi->audio_lock, flags);
1002 static void hdmi_video_sample(struct dw_hdmi *hdmi)
1007 switch (hdmi->hdmi_data.enc_in_bus_format) {
1055 hdmi_writeb(hdmi, val, HDMI_TX_INVID0);
1061 hdmi_writeb(hdmi, val, HDMI_TX_INSTUFFING);
1062 hdmi_writeb(hdmi, 0x0, HDMI_TX_GYDATA0);
1063 hdmi_writeb(hdmi, 0x0, HDMI_TX_GYDATA1);
1064 hdmi_writeb(hdmi, 0x0, HDMI_TX_RCRDATA0);
1065 hdmi_writeb(hdmi, 0x0, HDMI_TX_RCRDATA1);
1066 hdmi_writeb(hdmi, 0x0, HDMI_TX_BCBDATA0);
1067 hdmi_writeb(hdmi, 0x0, HDMI_TX_BCBDATA1);
1070 static int is_color_space_conversion(struct dw_hdmi *hdmi)
1072 struct hdmi_data_info *hdmi_data = &hdmi->hdmi_data;
1082 static int is_color_space_decimation(struct dw_hdmi *hdmi)
1084 if (!hdmi_bus_fmt_is_yuv422(hdmi->hdmi_data.enc_out_bus_format))
1087 if (hdmi_bus_fmt_is_rgb(hdmi->hdmi_data.enc_in_bus_format) ||
1088 hdmi_bus_fmt_is_yuv444(hdmi->hdmi_data.enc_in_bus_format))
1094 static int is_color_space_interpolation(struct dw_hdmi *hdmi)
1096 if (!hdmi_bus_fmt_is_yuv422(hdmi->hdmi_data.enc_in_bus_format))
1099 if (hdmi_bus_fmt_is_rgb(hdmi->hdmi_data.enc_out_bus_format) ||
1100 hdmi_bus_fmt_is_yuv444(hdmi->hdmi_data.enc_out_bus_format))
1106 static bool is_csc_needed(struct dw_hdmi *hdmi)
1108 return is_color_space_conversion(hdmi) ||
1109 is_color_space_decimation(hdmi) ||
1110 is_color_space_interpolation(hdmi);
1113 static void dw_hdmi_update_csc_coeffs(struct dw_hdmi *hdmi)
1120 is_input_rgb = hdmi_bus_fmt_is_rgb(hdmi->hdmi_data.enc_in_bus_format);
1121 is_output_rgb = hdmi_bus_fmt_is_rgb(hdmi->hdmi_data.enc_out_bus_format);
1124 if (hdmi->hdmi_data.enc_out_encoding == V4L2_YCBCR_ENC_601)
1129 if (hdmi->hdmi_data.enc_out_encoding == V4L2_YCBCR_ENC_601)
1135 hdmi->hdmi_data.rgb_limited_range) {
1145 hdmi_writeb(hdmi, coeff_a & 0xff, HDMI_CSC_COEF_A1_LSB + i * 2);
1146 hdmi_writeb(hdmi, coeff_a >> 8, HDMI_CSC_COEF_A1_MSB + i * 2);
1147 hdmi_writeb(hdmi, coeff_b & 0xff, HDMI_CSC_COEF_B1_LSB + i * 2);
1148 hdmi_writeb(hdmi, coeff_b >> 8, HDMI_CSC_COEF_B1_MSB + i * 2);
1149 hdmi_writeb(hdmi, coeff_c & 0xff, HDMI_CSC_COEF_C1_LSB + i * 2);
1150 hdmi_writeb(hdmi, coeff_c >> 8, HDMI_CSC_COEF_C1_MSB + i * 2);
1153 hdmi_modb(hdmi, csc_scale, HDMI_CSC_SCALE_CSCSCALE_MASK,
1157 static void hdmi_video_csc(struct dw_hdmi *hdmi)
1164 if (is_color_space_interpolation(hdmi))
1166 else if (is_color_space_decimation(hdmi))
1169 switch (hdmi_bus_fmt_color_depth(hdmi->hdmi_data.enc_out_bus_format)) {
1188 hdmi_writeb(hdmi, interpolation | decimation, HDMI_CSC_CFG);
1189 hdmi_modb(hdmi, color_depth, HDMI_CSC_SCALE_CSC_COLORDE_PTH_MASK,
1192 dw_hdmi_update_csc_coeffs(hdmi);
1200 static void hdmi_video_packetize(struct dw_hdmi *hdmi)
1205 struct hdmi_data_info *hdmi_data = &hdmi->hdmi_data;
1210 if (hdmi_bus_fmt_is_rgb(hdmi->hdmi_data.enc_out_bus_format) ||
1211 hdmi_bus_fmt_is_yuv444(hdmi->hdmi_data.enc_out_bus_format) ||
1212 hdmi_bus_fmt_is_yuv420(hdmi->hdmi_data.enc_out_bus_format)) {
1214 hdmi->hdmi_data.enc_out_bus_format)) {
1232 } else if (hdmi_bus_fmt_is_yuv422(hdmi->hdmi_data.enc_out_bus_format)) {
1234 hdmi->hdmi_data.enc_out_bus_format)) {
1261 hdmi_writeb(hdmi, val, HDMI_VP_PR_CD);
1269 val = hdmi_readb(hdmi, HDMI_FC_DATAUTO3);
1274 hdmi_writeb(hdmi, val, HDMI_FC_DATAUTO3);
1276 hdmi_modb(hdmi, HDMI_VP_STUFF_PR_STUFFING_STUFFING_MODE,
1288 hdmi_modb(hdmi, vp_conf,
1292 hdmi_modb(hdmi, 1 << HDMI_VP_STUFF_IDEFAULT_PHASE_OFFSET,
1295 hdmi_writeb(hdmi, remap_size, HDMI_VP_REMAP);
1313 hdmi_modb(hdmi, vp_conf,
1317 hdmi_modb(hdmi, HDMI_VP_STUFF_PP_STUFFING_STUFFING_MODE |
1322 hdmi_modb(hdmi, output_select, HDMI_VP_CONF_OUTPUT_SELECTOR_MASK,
1330 static inline void hdmi_phy_test_clear(struct dw_hdmi *hdmi,
1333 hdmi_modb(hdmi, bit << HDMI_PHY_TST0_TSTCLR_OFFSET,
1337 static bool hdmi_phy_wait_i2c_done(struct dw_hdmi *hdmi, int msec)
1341 while ((val = hdmi_readb(hdmi, HDMI_IH_I2CMPHY_STAT0) & 0x3) == 0) {
1346 hdmi_writeb(hdmi, val, HDMI_IH_I2CMPHY_STAT0);
1351 void dw_hdmi_phy_i2c_write(struct dw_hdmi *hdmi, unsigned short data,
1354 hdmi_writeb(hdmi, 0xFF, HDMI_IH_I2CMPHY_STAT0);
1355 hdmi_writeb(hdmi, addr, HDMI_PHY_I2CM_ADDRESS_ADDR);
1356 hdmi_writeb(hdmi, (unsigned char)(data >> 8),
1358 hdmi_writeb(hdmi, (unsigned char)(data >> 0),
1360 hdmi_writeb(hdmi, HDMI_PHY_I2CM_OPERATION_ADDR_WRITE,
1362 hdmi_phy_wait_i2c_done(hdmi, 1000);
1367 static bool dw_hdmi_support_scdc(struct dw_hdmi *hdmi,
1371 if (hdmi->version < 0x200a)
1375 if (!hdmi->ddc)
1379 if (!display->hdmi.scdc.supported ||
1380 !display->hdmi.scdc.scrambling.supported)
1387 if (!display->hdmi.scdc.scrambling.low_rates &&
1407 void dw_hdmi_set_high_tmds_clock_ratio(struct dw_hdmi *hdmi,
1410 unsigned long mtmdsclock = hdmi->hdmi_data.video_mode.mtmdsclock;
1413 if (dw_hdmi_support_scdc(hdmi, display)) {
1415 drm_scdc_set_high_tmds_clock_ratio(hdmi->curr_conn, 1);
1417 drm_scdc_set_high_tmds_clock_ratio(hdmi->curr_conn, 0);
1422 static void dw_hdmi_phy_enable_powerdown(struct dw_hdmi *hdmi, bool enable)
1424 hdmi_mask_writeb(hdmi, !enable, HDMI_PHY_CONF0,
1429 static void dw_hdmi_phy_enable_tmds(struct dw_hdmi *hdmi, u8 enable)
1431 hdmi_mask_writeb(hdmi, enable, HDMI_PHY_CONF0,
1436 static void dw_hdmi_phy_enable_svsret(struct dw_hdmi *hdmi, u8 enable)
1438 hdmi_mask_writeb(hdmi, enable, HDMI_PHY_CONF0,
1443 void dw_hdmi_phy_gen2_pddq(struct dw_hdmi *hdmi, u8 enable)
1445 hdmi_mask_writeb(hdmi, enable, HDMI_PHY_CONF0,
1451 void dw_hdmi_phy_gen2_txpwron(struct dw_hdmi *hdmi, u8 enable)
1453 hdmi_mask_writeb(hdmi, enable, HDMI_PHY_CONF0,
1459 static void dw_hdmi_phy_sel_data_en_pol(struct dw_hdmi *hdmi, u8 enable)
1461 hdmi_mask_writeb(hdmi, enable, HDMI_PHY_CONF0,
1466 static void dw_hdmi_phy_sel_interface_control(struct dw_hdmi *hdmi, u8 enable)
1468 hdmi_mask_writeb(hdmi, enable, HDMI_PHY_CONF0,
1473 void dw_hdmi_phy_gen1_reset(struct dw_hdmi *hdmi)
1476 hdmi_writeb(hdmi, 0, HDMI_MC_PHYRSTZ);
1477 hdmi_writeb(hdmi, HDMI_MC_PHYRSTZ_PHYRSTZ, HDMI_MC_PHYRSTZ);
1481 void dw_hdmi_phy_gen2_reset(struct dw_hdmi *hdmi)
1484 hdmi_writeb(hdmi, HDMI_MC_PHYRSTZ_PHYRSTZ, HDMI_MC_PHYRSTZ);
1485 hdmi_writeb(hdmi, 0, HDMI_MC_PHYRSTZ);
1489 void dw_hdmi_phy_i2c_set_addr(struct dw_hdmi *hdmi, u8 address)
1491 hdmi_phy_test_clear(hdmi, 1);
1492 hdmi_writeb(hdmi, address, HDMI_PHY_I2CM_SLAVE_ADDR);
1493 hdmi_phy_test_clear(hdmi, 0);
1497 static void dw_hdmi_phy_power_off(struct dw_hdmi *hdmi)
1499 const struct dw_hdmi_phy_data *phy = hdmi->phy.data;
1504 dw_hdmi_phy_enable_tmds(hdmi, 0);
1505 dw_hdmi_phy_enable_powerdown(hdmi, true);
1509 dw_hdmi_phy_gen2_txpwron(hdmi, 0);
1516 val = hdmi_readb(hdmi, HDMI_PHY_STAT0);
1524 dev_warn(hdmi->dev, "PHY failed to power down\n");
1526 dev_dbg(hdmi->dev, "PHY powered down in %u iterations\n", i);
1528 dw_hdmi_phy_gen2_pddq(hdmi, 1);
1531 static int dw_hdmi_phy_power_on(struct dw_hdmi *hdmi)
1533 const struct dw_hdmi_phy_data *phy = hdmi->phy.data;
1538 dw_hdmi_phy_enable_powerdown(hdmi, false);
1541 dw_hdmi_phy_enable_tmds(hdmi, 0);
1542 dw_hdmi_phy_enable_tmds(hdmi, 1);
1546 dw_hdmi_phy_gen2_txpwron(hdmi, 1);
1547 dw_hdmi_phy_gen2_pddq(hdmi, 0);
1551 val = hdmi_readb(hdmi, HDMI_PHY_STAT0) & HDMI_PHY_TX_PHY_LOCK;
1559 dev_err(hdmi->dev, "PHY PLL failed to lock\n");
1563 dev_dbg(hdmi->dev, "PHY PLL locked %u iterations\n", i);
1572 static int hdmi_phy_configure_dwc_hdmi_3d_tx(struct dw_hdmi *hdmi,
1600 dw_hdmi_phy_i2c_write(hdmi, mpll_config->res[0].cpce,
1602 dw_hdmi_phy_i2c_write(hdmi, mpll_config->res[0].gmp,
1604 dw_hdmi_phy_i2c_write(hdmi, curr_ctrl->curr[0],
1607 dw_hdmi_phy_i2c_write(hdmi, 0, HDMI_3D_TX_PHY_PLLPHBYCTRL);
1608 dw_hdmi_phy_i2c_write(hdmi, HDMI_3D_TX_PHY_MSM_CTRL_CKO_SEL_FB_CLK,
1611 dw_hdmi_phy_i2c_write(hdmi, phy_config->term, HDMI_3D_TX_PHY_TXTERM);
1612 dw_hdmi_phy_i2c_write(hdmi, phy_config->sym_ctr,
1614 dw_hdmi_phy_i2c_write(hdmi, phy_config->vlev_ctr,
1618 dw_hdmi_phy_i2c_write(hdmi, HDMI_3D_TX_PHY_CKCALCTRL_OVERRIDE,
1624 static int hdmi_phy_configure(struct dw_hdmi *hdmi,
1627 const struct dw_hdmi_phy_data *phy = hdmi->phy.data;
1628 const struct dw_hdmi_plat_data *pdata = hdmi->plat_data;
1629 unsigned long mpixelclock = hdmi->hdmi_data.video_mode.mpixelclock;
1630 unsigned long mtmdsclock = hdmi->hdmi_data.video_mode.mtmdsclock;
1633 dw_hdmi_phy_power_off(hdmi);
1635 dw_hdmi_set_high_tmds_clock_ratio(hdmi, display);
1639 dw_hdmi_phy_enable_svsret(hdmi, 1);
1641 dw_hdmi_phy_gen2_reset(hdmi);
1643 hdmi_writeb(hdmi, HDMI_MC_HEACPHY_RST_ASSERT, HDMI_MC_HEACPHY_RST);
1645 dw_hdmi_phy_i2c_set_addr(hdmi, HDMI_PHY_I2CM_SLAVE_ADDR_PHY_GEN2);
1649 ret = pdata->configure_phy(hdmi, pdata->priv_data, mpixelclock);
1651 ret = phy->configure(hdmi, pdata, mpixelclock);
1653 dev_err(hdmi->dev, "PHY configuration failed (clock %lu)\n",
1662 return dw_hdmi_phy_power_on(hdmi);
1665 static int dw_hdmi_phy_init(struct dw_hdmi *hdmi, void *data,
1673 dw_hdmi_phy_sel_data_en_pol(hdmi, 1);
1674 dw_hdmi_phy_sel_interface_control(hdmi, 0);
1676 ret = hdmi_phy_configure(hdmi, display);
1684 static void dw_hdmi_phy_disable(struct dw_hdmi *hdmi, void *data)
1686 dw_hdmi_phy_power_off(hdmi);
1689 enum drm_connector_status dw_hdmi_phy_read_hpd(struct dw_hdmi *hdmi,
1692 return hdmi_readb(hdmi, HDMI_PHY_STAT0) & HDMI_PHY_HPD ?
1697 void dw_hdmi_phy_update_hpd(struct dw_hdmi *hdmi, void *data,
1700 u8 old_mask = hdmi->phy_mask;
1703 hdmi->phy_mask |= HDMI_PHY_RX_SENSE;
1705 hdmi->phy_mask &= ~HDMI_PHY_RX_SENSE;
1707 if (old_mask != hdmi->phy_mask)
1708 hdmi_writeb(hdmi, hdmi->phy_mask, HDMI_PHY_MASK0);
1712 void dw_hdmi_phy_setup_hpd(struct dw_hdmi *hdmi, void *data)
1718 hdmi_writeb(hdmi, HDMI_PHY_HPD | HDMI_PHY_RX_SENSE, HDMI_PHY_POL0);
1719 hdmi_writeb(hdmi, HDMI_IH_PHY_STAT0_HPD | HDMI_IH_PHY_STAT0_RX_SENSE,
1723 hdmi_writeb(hdmi, hdmi->phy_mask, HDMI_PHY_MASK0);
1726 hdmi_writeb(hdmi, HDMI_IH_PHY_STAT0_HPD | HDMI_IH_PHY_STAT0_RX_SENSE,
1728 hdmi_writeb(hdmi, ~(HDMI_IH_PHY_STAT0_HPD | HDMI_IH_PHY_STAT0_RX_SENSE),
1745 static void hdmi_tx_hdcp_config(struct dw_hdmi *hdmi)
1749 if (hdmi->hdmi_data.video_mode.mdataenablepolarity)
1755 hdmi_modb(hdmi, HDMI_A_HDCPCFG0_RXDETECT_DISABLE,
1758 hdmi_modb(hdmi, de, HDMI_A_VIDPOLCFG_DATAENPOL_MASK, HDMI_A_VIDPOLCFG);
1760 hdmi_modb(hdmi, HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_DISABLE,
1764 static void hdmi_config_AVI(struct dw_hdmi *hdmi,
1774 if (hdmi_bus_fmt_is_rgb(hdmi->hdmi_data.enc_out_bus_format)) {
1776 hdmi->hdmi_data.rgb_limited_range ?
1785 if (hdmi_bus_fmt_is_yuv444(hdmi->hdmi_data.enc_out_bus_format))
1787 else if (hdmi_bus_fmt_is_yuv422(hdmi->hdmi_data.enc_out_bus_format))
1789 else if (hdmi_bus_fmt_is_yuv420(hdmi->hdmi_data.enc_out_bus_format))
1795 if (!hdmi_bus_fmt_is_rgb(hdmi->hdmi_data.enc_out_bus_format)) {
1796 switch (hdmi->hdmi_data.enc_out_encoding) {
1798 if (hdmi->hdmi_data.enc_in_encoding == V4L2_YCBCR_ENC_XV601)
1806 if (hdmi->hdmi_data.enc_in_encoding == V4L2_YCBCR_ENC_XV709)
1843 hdmi_writeb(hdmi, val, HDMI_FC_AVICONF0);
1849 hdmi_writeb(hdmi, val, HDMI_FC_AVICONF1);
1857 hdmi_writeb(hdmi, val, HDMI_FC_AVICONF2);
1861 hdmi_writeb(hdmi, val, HDMI_FC_AVIVID);
1864 val = (((hdmi->hdmi_data.video_mode.mpixelrepetitioninput + 1) <<
1867 ((hdmi->hdmi_data.video_mode.mpixelrepetitionoutput <<
1870 hdmi_writeb(hdmi, val, HDMI_FC_PRCONF);
1878 hdmi_writeb(hdmi, val, HDMI_FC_AVICONF3);
1881 hdmi_writeb(hdmi, frame.top_bar & 0xff, HDMI_FC_AVIETB0);
1882 hdmi_writeb(hdmi, (frame.top_bar >> 8) & 0xff, HDMI_FC_AVIETB1);
1883 hdmi_writeb(hdmi, frame.bottom_bar & 0xff, HDMI_FC_AVISBB0);
1884 hdmi_writeb(hdmi, (frame.bottom_bar >> 8) & 0xff, HDMI_FC_AVISBB1);
1885 hdmi_writeb(hdmi, frame.left_bar & 0xff, HDMI_FC_AVIELB0);
1886 hdmi_writeb(hdmi, (frame.left_bar >> 8) & 0xff, HDMI_FC_AVIELB1);
1887 hdmi_writeb(hdmi, frame.right_bar & 0xff, HDMI_FC_AVISRB0);
1888 hdmi_writeb(hdmi, (frame.right_bar >> 8) & 0xff, HDMI_FC_AVISRB1);
1891 static void hdmi_config_vendor_specific_infoframe(struct dw_hdmi *hdmi,
1912 dev_err(hdmi->dev, "Failed to pack vendor infoframe: %zd\n",
1916 hdmi_mask_writeb(hdmi, 0, HDMI_FC_DATAUTO0, HDMI_FC_DATAUTO0_VSD_OFFSET,
1920 hdmi_writeb(hdmi, buffer[2], HDMI_FC_VSDSIZE);
1923 hdmi_writeb(hdmi, buffer[4], HDMI_FC_VSDIEEEID0);
1924 hdmi_writeb(hdmi, buffer[5], HDMI_FC_VSDIEEEID1);
1925 hdmi_writeb(hdmi, buffer[6], HDMI_FC_VSDIEEEID2);
1928 hdmi_writeb(hdmi, buffer[7], HDMI_FC_VSDPAYLOAD0);
1929 hdmi_writeb(hdmi, buffer[8], HDMI_FC_VSDPAYLOAD1);
1932 hdmi_writeb(hdmi, buffer[9], HDMI_FC_VSDPAYLOAD2);
1935 hdmi_writeb(hdmi, 1, HDMI_FC_DATAUTO1);
1938 hdmi_writeb(hdmi, 0x11, HDMI_FC_DATAUTO2);
1941 hdmi_mask_writeb(hdmi, 1, HDMI_FC_DATAUTO0, HDMI_FC_DATAUTO0_VSD_OFFSET,
1945 static void hdmi_config_drm_infoframe(struct dw_hdmi *hdmi,
1954 if (!hdmi->plat_data->use_drm_infoframe)
1957 hdmi_modb(hdmi, HDMI_FC_PACKET_TX_EN_DRM_DISABLE,
1966 dev_err(hdmi->dev, "Failed to pack drm infoframe: %zd\n", err);
1970 hdmi_writeb(hdmi, frame.version, HDMI_FC_DRM_HB0);
1971 hdmi_writeb(hdmi, frame.length, HDMI_FC_DRM_HB1);
1974 hdmi_writeb(hdmi, buffer[4 + i], HDMI_FC_DRM_PB0 + i);
1976 hdmi_writeb(hdmi, 1, HDMI_FC_DRM_UP);
1977 hdmi_modb(hdmi, HDMI_FC_PACKET_TX_EN_DRM_ENABLE,
1981 static void hdmi_av_composer(struct dw_hdmi *hdmi,
1986 const struct drm_hdmi_info *hdmi_info = &display->hdmi;
1987 struct hdmi_vmode *vmode = &hdmi->hdmi_data.video_mode;
1993 dev_dbg(hdmi->dev, "final pixclk = %d\n", vmode->mpixelclock);
1997 if (!hdmi_bus_fmt_is_yuv422(hdmi->hdmi_data.enc_out_bus_format)) {
1999 hdmi->hdmi_data.enc_out_bus_format)) {
2012 if (hdmi_bus_fmt_is_yuv420(hdmi->hdmi_data.enc_out_bus_format))
2015 dev_dbg(hdmi->dev, "final tmdsclock = %d\n", vmode->mtmdsclock);
2018 inv_val = (hdmi->hdmi_data.hdcp_enable ||
2019 (dw_hdmi_support_scdc(hdmi, display) &&
2037 if (hdmi->vic == 39)
2048 inv_val |= hdmi->sink_is_hdmi ?
2052 hdmi_writeb(hdmi, inv_val, HDMI_FC_INVIDCONF);
2063 if (hdmi_bus_fmt_is_yuv420(hdmi->hdmi_data.enc_out_bus_format)) {
2087 if (dw_hdmi_support_scdc(hdmi, display)) {
2099 drm_scdc_readb(hdmi->ddc, SCDC_SINK_VERSION,
2101 drm_scdc_writeb(hdmi->ddc, SCDC_SOURCE_VERSION,
2105 drm_scdc_set_scrambling(hdmi->curr_conn, 1);
2114 hdmi_writeb(hdmi, (u8)~HDMI_MC_SWRSTZ_TMDSSWRST_REQ,
2116 hdmi_writeb(hdmi, 1, HDMI_FC_SCRAMBLER_CTRL);
2118 hdmi_writeb(hdmi, 0, HDMI_FC_SCRAMBLER_CTRL);
2119 hdmi_writeb(hdmi, (u8)~HDMI_MC_SWRSTZ_TMDSSWRST_REQ,
2121 drm_scdc_set_scrambling(hdmi->curr_conn, 0);
2126 hdmi_writeb(hdmi, hdisplay >> 8, HDMI_FC_INHACTV1);
2127 hdmi_writeb(hdmi, hdisplay, HDMI_FC_INHACTV0);
2130 hdmi_writeb(hdmi, vdisplay >> 8, HDMI_FC_INVACTV1);
2131 hdmi_writeb(hdmi, vdisplay, HDMI_FC_INVACTV0);
2134 hdmi_writeb(hdmi, hblank >> 8, HDMI_FC_INHBLANK1);
2135 hdmi_writeb(hdmi, hblank, HDMI_FC_INHBLANK0);
2138 hdmi_writeb(hdmi, vblank, HDMI_FC_INVBLANK);
2141 hdmi_writeb(hdmi, h_de_hs >> 8, HDMI_FC_HSYNCINDELAY1);
2142 hdmi_writeb(hdmi, h_de_hs, HDMI_FC_HSYNCINDELAY0);
2145 hdmi_writeb(hdmi, v_de_vs, HDMI_FC_VSYNCINDELAY);
2148 hdmi_writeb(hdmi, hsync_len >> 8, HDMI_FC_HSYNCINWIDTH1);
2149 hdmi_writeb(hdmi, hsync_len, HDMI_FC_HSYNCINWIDTH0);
2152 hdmi_writeb(hdmi, vsync_len, HDMI_FC_VSYNCINWIDTH);
2156 static void dw_hdmi_enable_video_path(struct dw_hdmi *hdmi)
2159 hdmi_writeb(hdmi, 12, HDMI_FC_CTRLDUR);
2160 hdmi_writeb(hdmi, 32, HDMI_FC_EXCTRLDUR);
2161 hdmi_writeb(hdmi, 1, HDMI_FC_EXCTRLSPAC);
2164 hdmi_writeb(hdmi, 0x0B, HDMI_FC_CH0PREAM);
2165 hdmi_writeb(hdmi, 0x16, HDMI_FC_CH1PREAM);
2166 hdmi_writeb(hdmi, 0x21, HDMI_FC_CH2PREAM);
2169 hdmi->mc_clkdis |= HDMI_MC_CLKDIS_HDCPCLK_DISABLE |
2174 hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_PIXELCLK_DISABLE;
2175 hdmi_writeb(hdmi, hdmi->mc_clkdis, HDMI_MC_CLKDIS);
2177 hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_TMDSCLK_DISABLE;
2178 hdmi_writeb(hdmi, hdmi->mc_clkdis, HDMI_MC_CLKDIS);
2181 if (is_csc_needed(hdmi)) {
2182 hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_CSCCLK_DISABLE;
2183 hdmi_writeb(hdmi, hdmi->mc_clkdis, HDMI_MC_CLKDIS);
2185 hdmi_writeb(hdmi, HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_CSC_IN_PATH,
2188 hdmi->mc_clkdis |= HDMI_MC_CLKDIS_CSCCLK_DISABLE;
2189 hdmi_writeb(hdmi, hdmi->mc_clkdis, HDMI_MC_CLKDIS);
2191 hdmi_writeb(hdmi, HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_CSC_BYPASS,
2197 static void dw_hdmi_clear_overflow(struct dw_hdmi *hdmi)
2218 switch (hdmi->version) {
2228 hdmi_writeb(hdmi, (u8)~HDMI_MC_SWRSTZ_TMDSSWRST_REQ, HDMI_MC_SWRSTZ);
2230 val = hdmi_readb(hdmi, HDMI_FC_INVIDCONF);
2232 hdmi_writeb(hdmi, val, HDMI_FC_INVIDCONF);
2235 static void hdmi_disable_overflow_interrupts(struct dw_hdmi *hdmi)
2237 hdmi_writeb(hdmi, HDMI_IH_MUTE_FC_STAT2_OVERFLOW_MASK,
2241 static int dw_hdmi_setup(struct dw_hdmi *hdmi,
2247 hdmi_disable_overflow_interrupts(hdmi);
2249 hdmi->vic = drm_match_cea_mode(mode);
2251 if (!hdmi->vic) {
2252 dev_dbg(hdmi->dev, "Non-CEA mode used in HDMI\n");
2254 dev_dbg(hdmi->dev, "CEA mode used vic=%d\n", hdmi->vic);
2257 if ((hdmi->vic == 6) || (hdmi->vic == 7) ||
2258 (hdmi->vic == 21) || (hdmi->vic == 22) ||
2259 (hdmi->vic == 2) || (hdmi->vic == 3) ||
2260 (hdmi->vic == 17) || (hdmi->vic == 18))
2261 hdmi->hdmi_data.enc_out_encoding = V4L2_YCBCR_ENC_601;
2263 hdmi->hdmi_data.enc_out_encoding = V4L2_YCBCR_ENC_709;
2265 hdmi->hdmi_data.video_mode.mpixelrepetitionoutput = 0;
2266 hdmi->hdmi_data.video_mode.mpixelrepetitioninput = 0;
2268 if (hdmi->hdmi_data.enc_in_bus_format == MEDIA_BUS_FMT_FIXED)
2269 hdmi->hdmi_data.enc_in_bus_format = MEDIA_BUS_FMT_RGB888_1X24;
2272 if (hdmi->plat_data->input_bus_encoding)
2273 hdmi->hdmi_data.enc_in_encoding =
2274 hdmi->plat_data->input_bus_encoding;
2276 hdmi->hdmi_data.enc_in_encoding = V4L2_YCBCR_ENC_DEFAULT;
2278 if (hdmi->hdmi_data.enc_out_bus_format == MEDIA_BUS_FMT_FIXED)
2279 hdmi->hdmi_data.enc_out_bus_format = MEDIA_BUS_FMT_RGB888_1X24;
2281 hdmi->hdmi_data.rgb_limited_range = hdmi->sink_is_hdmi &&
2285 hdmi->hdmi_data.pix_repet_factor = 0;
2286 hdmi->hdmi_data.hdcp_enable = 0;
2287 hdmi->hdmi_data.video_mode.mdataenablepolarity = true;
2290 hdmi_av_composer(hdmi, &connector->display_info, mode);
2293 ret = hdmi->phy.ops->init(hdmi, hdmi->phy.data,
2295 &hdmi->previous_mode);
2298 hdmi->phy.enabled = true;
2301 dw_hdmi_enable_video_path(hdmi);
2303 if (hdmi->sink_has_audio) {
2304 dev_dbg(hdmi->dev, "sink has audio support\n");
2307 hdmi_clk_regenerator_update_pixel_clock(hdmi);
2308 hdmi_enable_audio_clk(hdmi, hdmi->audio_enable);
2312 if (hdmi->sink_is_hdmi) {
2313 dev_dbg(hdmi->dev, "%s HDMI mode\n", __func__);
2316 hdmi_config_AVI(hdmi, connector, mode);
2317 hdmi_config_vendor_specific_infoframe(hdmi, connector, mode);
2318 hdmi_config_drm_infoframe(hdmi, connector);
2320 dev_dbg(hdmi->dev, "%s DVI mode\n", __func__);
2323 hdmi_video_packetize(hdmi);
2324 hdmi_video_csc(hdmi);
2325 hdmi_video_sample(hdmi);
2326 hdmi_tx_hdcp_config(hdmi);
2328 dw_hdmi_clear_overflow(hdmi);
2333 static void initialize_hdmi_ih_mutes(struct dw_hdmi *hdmi)
2344 ih_mute = hdmi_readb(hdmi, HDMI_IH_MUTE) |
2348 hdmi_writeb(hdmi, ih_mute, HDMI_IH_MUTE);
2351 hdmi_writeb(hdmi, 0xff, HDMI_VP_MASK);
2352 hdmi_writeb(hdmi, 0xff, HDMI_FC_MASK0);
2353 hdmi_writeb(hdmi, 0xff, HDMI_FC_MASK1);
2354 hdmi_writeb(hdmi, 0xff, HDMI_FC_MASK2);
2355 hdmi_writeb(hdmi, 0xff, HDMI_PHY_MASK0);
2356 hdmi_writeb(hdmi, 0xff, HDMI_PHY_I2CM_INT_ADDR);
2357 hdmi_writeb(hdmi, 0xff, HDMI_PHY_I2CM_CTLINT_ADDR);
2358 hdmi_writeb(hdmi, 0xff, HDMI_AUD_INT);
2359 hdmi_writeb(hdmi, 0xff, HDMI_AUD_SPDIFINT);
2360 hdmi_writeb(hdmi, 0xff, HDMI_AUD_HBR_MASK);
2361 hdmi_writeb(hdmi, 0xff, HDMI_GP_MASK);
2362 hdmi_writeb(hdmi, 0xff, HDMI_A_APIINTMSK);
2363 hdmi_writeb(hdmi, 0xff, HDMI_I2CM_INT);
2364 hdmi_writeb(hdmi, 0xff, HDMI_I2CM_CTLINT);
2367 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_FC_STAT0);
2368 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_FC_STAT1);
2369 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_FC_STAT2);
2370 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_AS_STAT0);
2371 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_PHY_STAT0);
2372 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_I2CM_STAT0);
2373 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_CEC_STAT0);
2374 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_VP_STAT0);
2375 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_I2CMPHY_STAT0);
2376 hdmi_writeb(hdmi, 0xff, HDMI_IH_MUTE_AHBDMAAUD_STAT0);
2381 hdmi_writeb(hdmi, ih_mute, HDMI_IH_MUTE);
2384 static void dw_hdmi_poweron(struct dw_hdmi *hdmi)
2386 hdmi->bridge_is_on = true;
2390 * is only be called when !hdmi->disabled.
2392 dw_hdmi_setup(hdmi, hdmi->curr_conn, &hdmi->previous_mode);
2395 static void dw_hdmi_poweroff(struct dw_hdmi *hdmi)
2397 if (hdmi->phy.enabled) {
2398 hdmi->phy.ops->disable(hdmi, hdmi->phy.data);
2399 hdmi->phy.enabled = false;
2402 hdmi->bridge_is_on = false;
2405 static void dw_hdmi_update_power(struct dw_hdmi *hdmi)
2407 int force = hdmi->force;
2409 if (hdmi->disabled) {
2412 if (hdmi->rxsense)
2419 if (hdmi->bridge_is_on)
2420 dw_hdmi_poweroff(hdmi);
2422 if (!hdmi->bridge_is_on)
2423 dw_hdmi_poweron(hdmi);
2439 static void dw_hdmi_update_phy_mask(struct dw_hdmi *hdmi)
2441 if (hdmi->phy.ops->update_hpd)
2442 hdmi->phy.ops->update_hpd(hdmi, hdmi->phy.data,
2443 hdmi->force, hdmi->disabled,
2444 hdmi->rxsense);
2447 static enum drm_connector_status dw_hdmi_detect(struct dw_hdmi *hdmi)
2451 result = hdmi->phy.ops->read_hpd(hdmi, hdmi->phy.data);
2452 hdmi->last_connector_result = result;
2457 static struct edid *dw_hdmi_get_edid(struct dw_hdmi *hdmi,
2462 if (!hdmi->ddc)
2465 edid = drm_get_edid(connector, hdmi->ddc);
2467 dev_dbg(hdmi->dev, "failed to get edid\n");
2471 dev_dbg(hdmi->dev, "got edid: width[%d] x height[%d]\n",
2474 hdmi->sink_is_hdmi = drm_detect_hdmi_monitor(edid);
2475 hdmi->sink_has_audio = drm_detect_monitor_audio(edid);
2487 struct dw_hdmi *hdmi = container_of(connector, struct dw_hdmi,
2489 return dw_hdmi_detect(hdmi);
2494 struct dw_hdmi *hdmi = container_of(connector, struct dw_hdmi,
2499 edid = dw_hdmi_get_edid(hdmi, connector);
2504 cec_notifier_set_phys_addr_from_edid(hdmi->cec_notifier, edid);
2537 struct dw_hdmi *hdmi = container_of(connector, struct dw_hdmi,
2540 mutex_lock(&hdmi->mutex);
2541 hdmi->force = connector->force;
2542 dw_hdmi_update_power(hdmi);
2543 dw_hdmi_update_phy_mask(hdmi);
2544 mutex_unlock(&hdmi->mutex);
2562 static int dw_hdmi_connector_create(struct dw_hdmi *hdmi)
2564 struct drm_connector *connector = &hdmi->connector;
2568 if (hdmi->version >= 0x200a)
2570 hdmi->plat_data->ycbcr_420_allowed;
2579 drm_connector_init_with_ddc(hdmi->bridge.dev, connector,
2582 hdmi->ddc);
2592 if (hdmi->version >= 0x200a && hdmi->plat_data->use_drm_infoframe)
2595 drm_connector_attach_encoder(connector, hdmi->bridge.encoder);
2599 notifier = cec_notifier_conn_register(hdmi->dev, NULL, &conn_info);
2603 mutex_lock(&hdmi->cec_notifier_mutex);
2604 hdmi->cec_notifier = notifier;
2605 mutex_unlock(&hdmi->cec_notifier_mutex);
2646 bool is_hdmi2_sink = info->hdmi.scdc.supported ||
2658 /* If dw-hdmi is the first or only bridge, avoid negociating with ourselves */
2677 (info->hdmi.y420_dc_modes & DRM_EDID_YCBCR420_DC_48))
2681 (info->hdmi.y420_dc_modes & DRM_EDID_YCBCR420_DC_36))
2685 (info->hdmi.y420_dc_modes & DRM_EDID_YCBCR420_DC_30))
2872 struct dw_hdmi *hdmi = bridge->driver_private;
2874 hdmi->hdmi_data.enc_out_bus_format =
2877 hdmi->hdmi_data.enc_in_bus_format =
2880 dev_dbg(hdmi->dev, "input format 0x%04x, output format 0x%04x\n",
2890 struct dw_hdmi *hdmi = bridge->driver_private;
2893 return drm_bridge_attach(bridge->encoder, hdmi->next_bridge,
2896 return dw_hdmi_connector_create(hdmi);
2901 struct dw_hdmi *hdmi = bridge->driver_private;
2903 mutex_lock(&hdmi->cec_notifier_mutex);
2904 cec_notifier_conn_unregister(hdmi->cec_notifier);
2905 hdmi->cec_notifier = NULL;
2906 mutex_unlock(&hdmi->cec_notifier_mutex);
2914 struct dw_hdmi *hdmi = bridge->driver_private;
2915 const struct dw_hdmi_plat_data *pdata = hdmi->plat_data;
2923 mode_status = pdata->mode_valid(hdmi, pdata->priv_data, info,
2933 struct dw_hdmi *hdmi = bridge->driver_private;
2935 mutex_lock(&hdmi->mutex);
2938 drm_mode_copy(&hdmi->previous_mode, mode);
2940 mutex_unlock(&hdmi->mutex);
2946 struct dw_hdmi *hdmi = bridge->driver_private;
2948 mutex_lock(&hdmi->mutex);
2949 hdmi->disabled = true;
2950 hdmi->curr_conn = NULL;
2951 dw_hdmi_update_power(hdmi);
2952 dw_hdmi_update_phy_mask(hdmi);
2953 handle_plugged_change(hdmi, false);
2954 mutex_unlock(&hdmi->mutex);
2960 struct dw_hdmi *hdmi = bridge->driver_private;
2967 mutex_lock(&hdmi->mutex);
2968 hdmi->disabled = false;
2969 hdmi->curr_conn = connector;
2970 dw_hdmi_update_power(hdmi);
2971 dw_hdmi_update_phy_mask(hdmi);
2972 handle_plugged_change(hdmi, true);
2973 mutex_unlock(&hdmi->mutex);
2978 struct dw_hdmi *hdmi = bridge->driver_private;
2980 return dw_hdmi_detect(hdmi);
2986 struct dw_hdmi *hdmi = bridge->driver_private;
2988 return dw_hdmi_get_edid(hdmi, connector);
3012 static irqreturn_t dw_hdmi_i2c_irq(struct dw_hdmi *hdmi)
3014 struct dw_hdmi_i2c *i2c = hdmi->i2c;
3017 stat = hdmi_readb(hdmi, HDMI_IH_I2CM_STAT0);
3021 hdmi_writeb(hdmi, stat, HDMI_IH_I2CM_STAT0);
3032 struct dw_hdmi *hdmi = dev_id;
3036 if (hdmi->i2c)
3037 ret = dw_hdmi_i2c_irq(hdmi);
3039 intr_stat = hdmi_readb(hdmi, HDMI_IH_PHY_STAT0);
3041 hdmi_writeb(hdmi, ~0, HDMI_IH_MUTE_PHY_STAT0);
3048 void dw_hdmi_setup_rx_sense(struct dw_hdmi *hdmi, bool hpd, bool rx_sense)
3050 mutex_lock(&hdmi->mutex);
3052 if (!hdmi->force) {
3058 hdmi->rxsense = false;
3067 hdmi->rxsense = true;
3069 dw_hdmi_update_power(hdmi);
3070 dw_hdmi_update_phy_mask(hdmi);
3072 mutex_unlock(&hdmi->mutex);
3078 struct dw_hdmi *hdmi = dev_id;
3082 intr_stat = hdmi_readb(hdmi, HDMI_IH_PHY_STAT0);
3083 phy_int_pol = hdmi_readb(hdmi, HDMI_PHY_POL0);
3084 phy_stat = hdmi_readb(hdmi, HDMI_PHY_STAT0);
3099 hdmi_modb(hdmi, ~phy_int_pol, phy_pol_mask, HDMI_PHY_POL0);
3110 dw_hdmi_setup_rx_sense(hdmi,
3115 mutex_lock(&hdmi->cec_notifier_mutex);
3116 cec_notifier_phys_addr_invalidate(hdmi->cec_notifier);
3117 mutex_unlock(&hdmi->cec_notifier_mutex);
3128 dev_dbg(hdmi->dev, "EVENT=%s\n",
3132 if (hdmi->bridge.dev) {
3133 drm_helper_hpd_irq_event(hdmi->bridge.dev);
3134 drm_bridge_hpd_notify(&hdmi->bridge, status);
3138 hdmi_writeb(hdmi, intr_stat, HDMI_IH_PHY_STAT0);
3139 hdmi_writeb(hdmi, ~(HDMI_IH_PHY_STAT0_HPD | HDMI_IH_PHY_STAT0_RX_SENSE),
3184 static int dw_hdmi_detect_phy(struct dw_hdmi *hdmi)
3189 phy_type = hdmi->plat_data->phy_force_vendor ?
3191 hdmi_readb(hdmi, HDMI_CONFIG2_ID);
3195 if (!hdmi->plat_data->phy_ops || !hdmi->plat_data->phy_name) {
3196 dev_err(hdmi->dev,
3201 hdmi->phy.ops = hdmi->plat_data->phy_ops;
3202 hdmi->phy.data = hdmi->plat_data->phy_data;
3203 hdmi->phy.name = hdmi->plat_data->phy_name;
3210 hdmi->phy.ops = &dw_hdmi_synopsys_phy_ops;
3211 hdmi->phy.name = dw_hdmi_phys[i].name;
3212 hdmi->phy.data = (void *)&dw_hdmi_phys[i];
3215 !hdmi->plat_data->configure_phy) {
3216 dev_err(hdmi->dev, "%s requires platform support\n",
3217 hdmi->phy.name);
3225 dev_err(hdmi->dev, "Unsupported HDMI PHY type (%02x)\n", phy_type);
3229 static void dw_hdmi_cec_enable(struct dw_hdmi *hdmi)
3231 mutex_lock(&hdmi->mutex);
3232 hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_CECCLK_DISABLE;
3233 hdmi_writeb(hdmi, hdmi->mc_clkdis, HDMI_MC_CLKDIS);
3234 mutex_unlock(&hdmi->mutex);
3237 static void dw_hdmi_cec_disable(struct dw_hdmi *hdmi)
3239 mutex_lock(&hdmi->mutex);
3240 hdmi->mc_clkdis |= HDMI_MC_CLKDIS_CECCLK_DISABLE;
3241 hdmi_writeb(hdmi, hdmi->mc_clkdis, HDMI_MC_CLKDIS);
3242 mutex_unlock(&hdmi->mutex);
3266 static void dw_hdmi_init_hw(struct dw_hdmi *hdmi)
3268 initialize_hdmi_ih_mutes(hdmi);
3275 dw_hdmi_i2c_init(hdmi);
3277 if (hdmi->phy.ops->setup_hpd)
3278 hdmi->phy.ops->setup_hpd(hdmi, hdmi->phy.data);
3285 static int dw_hdmi_parse_dt(struct dw_hdmi *hdmi)
3290 if (!hdmi->plat_data->output_port)
3293 endpoint = of_graph_get_endpoint_by_regs(hdmi->dev->of_node,
3294 hdmi->plat_data->output_port,
3302 dev_err(hdmi->dev, "Missing endpoint in port@%u\n",
3303 hdmi->plat_data->output_port);
3310 dev_err(hdmi->dev, "Endpoint in port@%u unconnected\n",
3311 hdmi->plat_data->output_port);
3316 dev_err(hdmi->dev, "port@%u remote device is disabled\n",
3317 hdmi->plat_data->output_port);
3322 hdmi->next_bridge = of_drm_find_bridge(remote);
3324 if (!hdmi->next_bridge)
3330 bool dw_hdmi_bus_fmt_is_420(struct dw_hdmi *hdmi)
3332 return hdmi_bus_fmt_is_yuv420(hdmi->hdmi_data.enc_out_bus_format);
3344 struct dw_hdmi *hdmi;
3354 hdmi = devm_kzalloc(dev, sizeof(*hdmi), GFP_KERNEL);
3355 if (!hdmi)
3358 hdmi->plat_data = plat_data;
3359 hdmi->dev = dev;
3360 hdmi->sample_rate = 48000;
3361 hdmi->channels = 2;
3362 hdmi->disabled = true;
3363 hdmi->rxsense = true;
3364 hdmi->phy_mask = (u8)~(HDMI_PHY_HPD | HDMI_PHY_RX_SENSE);
3365 hdmi->mc_clkdis = 0x7f;
3366 hdmi->last_connector_result = connector_status_disconnected;
3368 mutex_init(&hdmi->mutex);
3369 mutex_init(&hdmi->audio_mutex);
3370 mutex_init(&hdmi->cec_notifier_mutex);
3371 spin_lock_init(&hdmi->audio_lock);
3373 ret = dw_hdmi_parse_dt(hdmi);
3379 hdmi->ddc = of_get_i2c_adapter_by_node(ddc_node);
3381 if (!hdmi->ddc) {
3382 dev_dbg(hdmi->dev, "failed to read ddc node\n");
3387 dev_dbg(hdmi->dev, "no ddc property found\n");
3397 hdmi->reg_shift = 2;
3408 hdmi->regs = devm_ioremap_resource(dev, iores);
3409 if (IS_ERR(hdmi->regs)) {
3410 ret = PTR_ERR(hdmi->regs);
3414 hdmi->regm = devm_regmap_init_mmio(dev, hdmi->regs, reg_config);
3415 if (IS_ERR(hdmi->regm)) {
3417 ret = PTR_ERR(hdmi->regm);
3421 hdmi->regm = plat_data->regm;
3424 hdmi->isfr_clk = devm_clk_get(hdmi->dev, "isfr");
3425 if (IS_ERR(hdmi->isfr_clk)) {
3426 ret = PTR_ERR(hdmi->isfr_clk);
3427 dev_err(hdmi->dev, "Unable to get HDMI isfr clk: %d\n", ret);
3431 ret = clk_prepare_enable(hdmi->isfr_clk);
3433 dev_err(hdmi->dev, "Cannot enable HDMI isfr clock: %d\n", ret);
3437 hdmi->iahb_clk = devm_clk_get(hdmi->dev, "iahb");
3438 if (IS_ERR(hdmi->iahb_clk)) {
3439 ret = PTR_ERR(hdmi->iahb_clk);
3440 dev_err(hdmi->dev, "Unable to get HDMI iahb clk: %d\n", ret);
3444 ret = clk_prepare_enable(hdmi->iahb_clk);
3446 dev_err(hdmi->dev, "Cannot enable HDMI iahb clock: %d\n", ret);
3450 hdmi->cec_clk = devm_clk_get(hdmi->dev, "cec");
3451 if (PTR_ERR(hdmi->cec_clk) == -ENOENT) {
3452 hdmi->cec_clk = NULL;
3453 } else if (IS_ERR(hdmi->cec_clk)) {
3454 ret = PTR_ERR(hdmi->cec_clk);
3456 dev_err(hdmi->dev, "Cannot get HDMI cec clock: %d\n",
3459 hdmi->cec_clk = NULL;
3462 ret = clk_prepare_enable(hdmi->cec_clk);
3464 dev_err(hdmi->dev, "Cannot enable HDMI cec clock: %d\n",
3471 hdmi->version = (hdmi_readb(hdmi, HDMI_DESIGN_ID) << 8)
3472 | (hdmi_readb(hdmi, HDMI_REVISION_ID) << 0);
3473 prod_id0 = hdmi_readb(hdmi, HDMI_PRODUCT_ID0);
3474 prod_id1 = hdmi_readb(hdmi, HDMI_PRODUCT_ID1);
3479 hdmi->version, prod_id0, prod_id1);
3484 ret = dw_hdmi_detect_phy(hdmi);
3489 hdmi->version >> 12, hdmi->version & 0xfff,
3491 hdmi->phy.name);
3493 dw_hdmi_init_hw(hdmi);
3503 dev_name(dev), hdmi);
3511 hdmi_init_clk_regenerator(hdmi);
3514 if (!hdmi->ddc) {
3516 hdmi->pinctrl = devm_pinctrl_get(dev);
3517 if (!IS_ERR(hdmi->pinctrl)) {
3518 hdmi->unwedge_state =
3519 pinctrl_lookup_state(hdmi->pinctrl, "unwedge");
3520 hdmi->default_state =
3521 pinctrl_lookup_state(hdmi->pinctrl, "default");
3523 if (IS_ERR(hdmi->default_state) ||
3524 IS_ERR(hdmi->unwedge_state)) {
3525 if (!IS_ERR(hdmi->unwedge_state))
3528 hdmi->default_state = NULL;
3529 hdmi->unwedge_state = NULL;
3533 hdmi->ddc = dw_hdmi_i2c_adapter(hdmi);
3534 if (IS_ERR(hdmi->ddc))
3535 hdmi->ddc = NULL;
3538 hdmi->bridge.driver_private = hdmi;
3539 hdmi->bridge.funcs = &dw_hdmi_bridge_funcs;
3540 hdmi->bridge.ops = DRM_BRIDGE_OP_DETECT | DRM_BRIDGE_OP_EDID
3542 hdmi->bridge.interlace_allowed = true;
3543 hdmi->bridge.ddc = hdmi->ddc;
3545 hdmi->bridge.of_node = pdev->dev.of_node;
3552 config0 = hdmi_readb(hdmi, HDMI_CONFIG0_ID);
3553 config3 = hdmi_readb(hdmi, HDMI_CONFIG3_ID);
3559 audio.base = hdmi->regs;
3561 audio.hdmi = hdmi;
3563 hdmi->enable_audio = dw_hdmi_ahb_audio_enable;
3564 hdmi->disable_audio = dw_hdmi_ahb_audio_disable;
3566 pdevinfo.name = "dw-hdmi-ahb-audio";
3570 hdmi->audio = platform_device_register_full(&pdevinfo);
3574 audio.hdmi = hdmi;
3578 hdmi->enable_audio = dw_hdmi_i2s_audio_enable;
3579 hdmi->disable_audio = dw_hdmi_i2s_audio_disable;
3581 pdevinfo.name = "dw-hdmi-i2s-audio";
3585 hdmi->audio = platform_device_register_full(&pdevinfo);
3590 audio.base = hdmi->regs;
3592 audio.hdmi = hdmi;
3595 hdmi->enable_audio = dw_hdmi_gp_audio_enable;
3596 hdmi->disable_audio = dw_hdmi_gp_audio_disable;
3598 pdevinfo.name = "dw-hdmi-gp-audio";
3603 hdmi->audio = platform_device_register_full(&pdevinfo);
3607 cec.hdmi = hdmi;
3611 pdevinfo.name = "dw-hdmi-cec";
3616 hdmi->cec = platform_device_register_full(&pdevinfo);
3619 drm_bridge_add(&hdmi->bridge);
3621 return hdmi;
3624 clk_disable_unprepare(hdmi->iahb_clk);
3625 clk_disable_unprepare(hdmi->cec_clk);
3627 clk_disable_unprepare(hdmi->isfr_clk);
3629 i2c_put_adapter(hdmi->ddc);
3635 void dw_hdmi_remove(struct dw_hdmi *hdmi)
3637 drm_bridge_remove(&hdmi->bridge);
3639 if (hdmi->audio && !IS_ERR(hdmi->audio))
3640 platform_device_unregister(hdmi->audio);
3641 if (!IS_ERR(hdmi->cec))
3642 platform_device_unregister(hdmi->cec);
3645 hdmi_writeb(hdmi, ~0, HDMI_IH_MUTE_PHY_STAT0);
3647 clk_disable_unprepare(hdmi->iahb_clk);
3648 clk_disable_unprepare(hdmi->isfr_clk);
3649 clk_disable_unprepare(hdmi->cec_clk);
3651 if (hdmi->i2c)
3652 i2c_del_adapter(&hdmi->i2c->adap);
3654 i2c_put_adapter(hdmi->ddc);
3665 struct dw_hdmi *hdmi;
3668 hdmi = dw_hdmi_probe(pdev, plat_data);
3669 if (IS_ERR(hdmi))
3670 return hdmi;
3672 ret = drm_bridge_attach(encoder, &hdmi->bridge, NULL, 0);
3674 dw_hdmi_remove(hdmi);
3678 return hdmi;
3682 void dw_hdmi_unbind(struct dw_hdmi *hdmi)
3684 dw_hdmi_remove(hdmi);
3688 void dw_hdmi_resume(struct dw_hdmi *hdmi)
3690 dw_hdmi_init_hw(hdmi);
3700 MODULE_ALIAS("platform:dw-hdmi");