183 static u32 mtk_hdmi_read(struct mtk_hdmi *hdmi, u32 offset)  in mtk_hdmi_read()  argument
185 	return readl(hdmi->regs + offset);  in mtk_hdmi_read()
188 static void mtk_hdmi_write(struct mtk_hdmi *hdmi, u32 offset, u32 val)  in mtk_hdmi_write()  argument
190 	writel(val, hdmi->regs + offset);  in mtk_hdmi_write()
193 static void mtk_hdmi_clear_bits(struct mtk_hdmi *hdmi, u32 offset, u32 bits)  in mtk_hdmi_clear_bits()  argument
195 	void __iomem *reg = hdmi->regs + offset;  in mtk_hdmi_clear_bits()
203 static void mtk_hdmi_set_bits(struct mtk_hdmi *hdmi, u32 offset, u32 bits)  in mtk_hdmi_set_bits()  argument
205 	void __iomem *reg = hdmi->regs + offset;  in mtk_hdmi_set_bits()
213 static void mtk_hdmi_mask(struct mtk_hdmi *hdmi, u32 offset, u32 val, u32 mask)  in mtk_hdmi_mask()  argument
215 	void __iomem *reg = hdmi->regs + offset;  in mtk_hdmi_mask()
223 static void mtk_hdmi_hw_vid_black(struct mtk_hdmi *hdmi, bool black)  in mtk_hdmi_hw_vid_black()  argument
225 	mtk_hdmi_mask(hdmi, VIDEO_CFG_4, black ? GEN_RGB : NORMAL_PATH,  in mtk_hdmi_hw_vid_black()
229 static void mtk_hdmi_hw_make_reg_writable(struct mtk_hdmi *hdmi, bool enable)  in mtk_hdmi_hw_make_reg_writable()  argument
232 	struct mtk_hdmi_phy *hdmi_phy = phy_get_drvdata(hdmi->phy);  in mtk_hdmi_hw_make_reg_writable()
241 		regmap_update_bits(hdmi->sys_regmap,  in mtk_hdmi_hw_make_reg_writable()
242 				   hdmi->sys_offset + HDMI_SYS_CFG20,  in mtk_hdmi_hw_make_reg_writable()
248 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG20,  in mtk_hdmi_hw_make_reg_writable()
250 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG1C,  in mtk_hdmi_hw_make_reg_writable()
254 static void mtk_hdmi_hw_1p4_version_enable(struct mtk_hdmi *hdmi, bool enable)  in mtk_hdmi_hw_1p4_version_enable()  argument
256 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG20,  in mtk_hdmi_hw_1p4_version_enable()
260 static void mtk_hdmi_hw_aud_mute(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_aud_mute()  argument
262 	mtk_hdmi_set_bits(hdmi, GRL_AUDIO_CFG, AUDIO_ZERO);  in mtk_hdmi_hw_aud_mute()
265 static void mtk_hdmi_hw_aud_unmute(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_aud_unmute()  argument
267 	mtk_hdmi_clear_bits(hdmi, GRL_AUDIO_CFG, AUDIO_ZERO);  in mtk_hdmi_hw_aud_unmute()
270 static void mtk_hdmi_hw_reset(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_reset()  argument
272 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG1C,  in mtk_hdmi_hw_reset()
274 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG1C,  in mtk_hdmi_hw_reset()
276 	mtk_hdmi_clear_bits(hdmi, GRL_CFG3, CFG3_CONTROL_PACKET_DELAY);  in mtk_hdmi_hw_reset()
277 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG1C,  in mtk_hdmi_hw_reset()
281 static void mtk_hdmi_hw_enable_notice(struct mtk_hdmi *hdmi, bool enable_notice)  in mtk_hdmi_hw_enable_notice()  argument
283 	mtk_hdmi_mask(hdmi, GRL_CFG2, enable_notice ? CFG2_NOTICE_EN : 0,  in mtk_hdmi_hw_enable_notice()
287 static void mtk_hdmi_hw_write_int_mask(struct mtk_hdmi *hdmi, u32 int_mask)  in mtk_hdmi_hw_write_int_mask()  argument
289 	mtk_hdmi_write(hdmi, GRL_INT_MASK, int_mask);  in mtk_hdmi_hw_write_int_mask()
292 static void mtk_hdmi_hw_enable_dvi_mode(struct mtk_hdmi *hdmi, bool enable)  in mtk_hdmi_hw_enable_dvi_mode()  argument
294 	mtk_hdmi_mask(hdmi, GRL_CFG1, enable ? CFG1_DVI : 0, CFG1_DVI);  in mtk_hdmi_hw_enable_dvi_mode()
297 static void mtk_hdmi_hw_send_info_frame(struct mtk_hdmi *hdmi, u8 *buffer,  in mtk_hdmi_hw_send_info_frame()  argument
319 	dev_dbg(hdmi->dev,  in mtk_hdmi_hw_send_info_frame()
341 		dev_err(hdmi->dev, "Unknown infoframe type %d\n", frame_type);  in mtk_hdmi_hw_send_info_frame()
344 	mtk_hdmi_clear_bits(hdmi, ctrl_reg, ctrl_frame_en);  in mtk_hdmi_hw_send_info_frame()
345 	mtk_hdmi_write(hdmi, GRL_INFOFRM_TYPE, frame_type);  in mtk_hdmi_hw_send_info_frame()
346 	mtk_hdmi_write(hdmi, GRL_INFOFRM_VER, frame_ver);  in mtk_hdmi_hw_send_info_frame()
347 	mtk_hdmi_write(hdmi, GRL_INFOFRM_LNG, frame_len);  in mtk_hdmi_hw_send_info_frame()
349 	mtk_hdmi_write(hdmi, GRL_IFM_PORT, checksum);  in mtk_hdmi_hw_send_info_frame()
351 		mtk_hdmi_write(hdmi, GRL_IFM_PORT, frame_data[i]);  in mtk_hdmi_hw_send_info_frame()
353 	mtk_hdmi_set_bits(hdmi, ctrl_reg, ctrl_frame_en);  in mtk_hdmi_hw_send_info_frame()
356 static void mtk_hdmi_hw_send_aud_packet(struct mtk_hdmi *hdmi, bool enable)  in mtk_hdmi_hw_send_aud_packet()  argument
358 	mtk_hdmi_mask(hdmi, GRL_SHIFT_R2, enable ? 0 : AUDIO_PACKET_OFF,  in mtk_hdmi_hw_send_aud_packet()
362 static void mtk_hdmi_hw_config_sys(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_config_sys()  argument
364 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG20,  in mtk_hdmi_hw_config_sys()
367 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG20,  in mtk_hdmi_hw_config_sys()
371 static void mtk_hdmi_hw_set_deep_color_mode(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_set_deep_color_mode()  argument
373 	regmap_update_bits(hdmi->sys_regmap, hdmi->sys_offset + HDMI_SYS_CFG20,  in mtk_hdmi_hw_set_deep_color_mode()
378 static void mtk_hdmi_hw_send_av_mute(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_send_av_mute()  argument
380 	mtk_hdmi_clear_bits(hdmi, GRL_CFG4, CTRL_AVMUTE);  in mtk_hdmi_hw_send_av_mute()
382 	mtk_hdmi_set_bits(hdmi, GRL_CFG4, CTRL_AVMUTE);  in mtk_hdmi_hw_send_av_mute()
385 static void mtk_hdmi_hw_send_av_unmute(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_send_av_unmute()  argument
387 	mtk_hdmi_mask(hdmi, GRL_CFG4, CFG4_AV_UNMUTE_EN,  in mtk_hdmi_hw_send_av_unmute()
390 	mtk_hdmi_mask(hdmi, GRL_CFG4, CFG4_AV_UNMUTE_SET,  in mtk_hdmi_hw_send_av_unmute()
394 static void mtk_hdmi_hw_ncts_enable(struct mtk_hdmi *hdmi, bool on)  in mtk_hdmi_hw_ncts_enable()  argument
396 	mtk_hdmi_mask(hdmi, GRL_CTS_CTRL, on ? 0 : CTS_CTRL_SOFT,  in mtk_hdmi_hw_ncts_enable()
400 static void mtk_hdmi_hw_ncts_auto_write_enable(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_ncts_auto_write_enable()  argument
403 	mtk_hdmi_mask(hdmi, GRL_CTS_CTRL, enable ? NCTS_WRI_ANYTIME : 0,  in mtk_hdmi_hw_ncts_auto_write_enable()
407 static void mtk_hdmi_hw_msic_setting(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_msic_setting()  argument
410 	mtk_hdmi_clear_bits(hdmi, GRL_CFG4, CFG4_MHL_MODE);  in mtk_hdmi_hw_msic_setting()
415 		mtk_hdmi_clear_bits(hdmi, GRL_CFG2, CFG2_MHL_DE_SEL);  in mtk_hdmi_hw_msic_setting()
417 		mtk_hdmi_set_bits(hdmi, GRL_CFG2, CFG2_MHL_DE_SEL);  in mtk_hdmi_hw_msic_setting()
420 static void mtk_hdmi_hw_aud_set_channel_swap(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_aud_set_channel_swap()  argument
445 	mtk_hdmi_mask(hdmi, GRL_CH_SWAP, swap_bit, 0xff);  in mtk_hdmi_hw_aud_set_channel_swap()
448 static void mtk_hdmi_hw_aud_set_bit_num(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_aud_set_bit_num()  argument
466 	mtk_hdmi_mask(hdmi, GRL_AOUT_CFG, val, AOUT_BNUM_SEL_MASK);  in mtk_hdmi_hw_aud_set_bit_num()
469 static void mtk_hdmi_hw_aud_set_i2s_fmt(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_aud_set_i2s_fmt()  argument
474 	val = mtk_hdmi_read(hdmi, GRL_CFG0);  in mtk_hdmi_hw_aud_set_i2s_fmt()
498 	mtk_hdmi_write(hdmi, GRL_CFG0, val);  in mtk_hdmi_hw_aud_set_i2s_fmt()
501 static void mtk_hdmi_hw_audio_config(struct mtk_hdmi *hdmi, bool dst)  in mtk_hdmi_hw_audio_config()  argument
507 	mtk_hdmi_clear_bits(hdmi, GRL_AOUT_CFG, HIGH_BIT_RATE_PACKET_ALIGN);  in mtk_hdmi_hw_audio_config()
514 	mtk_hdmi_mask(hdmi, GRL_AUDIO_CFG, val, mask);  in mtk_hdmi_hw_audio_config()
517 static void mtk_hdmi_hw_aud_set_i2s_chan_num(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_aud_set_i2s_chan_num()  argument
555 	mtk_hdmi_write(hdmi, GRL_CH_SW0, ch_switch & 0xff);  in mtk_hdmi_hw_aud_set_i2s_chan_num()
556 	mtk_hdmi_write(hdmi, GRL_CH_SW1, (ch_switch >> 8) & 0xff);  in mtk_hdmi_hw_aud_set_i2s_chan_num()
557 	mtk_hdmi_write(hdmi, GRL_CH_SW2, (ch_switch >> 16) & 0xff);  in mtk_hdmi_hw_aud_set_i2s_chan_num()
558 	mtk_hdmi_write(hdmi, GRL_I2S_UV, i2s_uv);  in mtk_hdmi_hw_aud_set_i2s_chan_num()
561 static void mtk_hdmi_hw_aud_set_input_type(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_aud_set_input_type()  argument
566 	val = mtk_hdmi_read(hdmi, GRL_CFG1);  in mtk_hdmi_hw_aud_set_input_type()
574 	mtk_hdmi_write(hdmi, GRL_CFG1, val);  in mtk_hdmi_hw_aud_set_input_type()
577 static void mtk_hdmi_hw_aud_set_channel_status(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_aud_set_channel_status()  argument
583 		mtk_hdmi_write(hdmi, GRL_I2S_C_STA0 + i * 4, channel_status[i]);  in mtk_hdmi_hw_aud_set_channel_status()
584 		mtk_hdmi_write(hdmi, GRL_L_STATUS_0 + i * 4, channel_status[i]);  in mtk_hdmi_hw_aud_set_channel_status()
585 		mtk_hdmi_write(hdmi, GRL_R_STATUS_0 + i * 4, channel_status[i]);  in mtk_hdmi_hw_aud_set_channel_status()
588 		mtk_hdmi_write(hdmi, GRL_L_STATUS_0 + i * 4, 0);  in mtk_hdmi_hw_aud_set_channel_status()
589 		mtk_hdmi_write(hdmi, GRL_R_STATUS_0 + i * 4, 0);  in mtk_hdmi_hw_aud_set_channel_status()
593 static void mtk_hdmi_hw_aud_src_reenable(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_aud_src_reenable()  argument
597 	val = mtk_hdmi_read(hdmi, GRL_MIX_CTRL);  in mtk_hdmi_hw_aud_src_reenable()
600 		mtk_hdmi_write(hdmi, GRL_MIX_CTRL, val);  in mtk_hdmi_hw_aud_src_reenable()
603 		mtk_hdmi_write(hdmi, GRL_MIX_CTRL, val);  in mtk_hdmi_hw_aud_src_reenable()
607 static void mtk_hdmi_hw_aud_src_disable(struct mtk_hdmi *hdmi)  in mtk_hdmi_hw_aud_src_disable()  argument
611 	val = mtk_hdmi_read(hdmi, GRL_MIX_CTRL);  in mtk_hdmi_hw_aud_src_disable()
613 	mtk_hdmi_write(hdmi, GRL_MIX_CTRL, val);  in mtk_hdmi_hw_aud_src_disable()
614 	mtk_hdmi_write(hdmi, GRL_SHIFT_L1, 0x00);  in mtk_hdmi_hw_aud_src_disable()
617 static void mtk_hdmi_hw_aud_set_mclk(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_aud_set_mclk()  argument
622 	val = mtk_hdmi_read(hdmi, GRL_CFG5);  in mtk_hdmi_hw_aud_set_mclk()
645 	mtk_hdmi_write(hdmi, GRL_CFG5, val);  in mtk_hdmi_hw_aud_set_mclk()
723 static void do_hdmi_hw_aud_set_ncts(struct mtk_hdmi *hdmi, unsigned int n,  in do_hdmi_hw_aud_set_ncts()  argument
729 	mtk_hdmi_write(hdmi, GRL_NCTS, 0);  in do_hdmi_hw_aud_set_ncts()
730 	mtk_hdmi_write(hdmi, GRL_NCTS, 0);  in do_hdmi_hw_aud_set_ncts()
731 	mtk_hdmi_write(hdmi, GRL_NCTS, 0);  in do_hdmi_hw_aud_set_ncts()
744 		mtk_hdmi_write(hdmi, GRL_NCTS, val[i]);  in do_hdmi_hw_aud_set_ncts()
747 static void mtk_hdmi_hw_aud_set_ncts(struct mtk_hdmi *hdmi,  in mtk_hdmi_hw_aud_set_ncts()  argument
756 	dev_dbg(hdmi->dev, "%s: sample_rate=%u, clock=%d, cts=%u, n=%u\n",  in mtk_hdmi_hw_aud_set_ncts()
759 	mtk_hdmi_mask(hdmi, DUMMY_304, AUDIO_I2S_NCTS_SEL_64,  in mtk_hdmi_hw_aud_set_ncts()
761 	do_hdmi_hw_aud_set_ncts(hdmi, n, cts);  in mtk_hdmi_hw_aud_set_ncts()
834 static int mtk_hdmi_video_change_vpll(struct mtk_hdmi *hdmi, u32 clock)  in mtk_hdmi_video_change_vpll()  argument
840 	ret = clk_set_rate(hdmi->clk[MTK_HDMI_CLK_HDMI_PLL], clock);  in mtk_hdmi_video_change_vpll()
842 		dev_err(hdmi->dev, "Failed to set PLL to %u Hz: %d\n", clock,  in mtk_hdmi_video_change_vpll()
847 	rate = clk_get_rate(hdmi->clk[MTK_HDMI_CLK_HDMI_PLL]);  in mtk_hdmi_video_change_vpll()
850 		dev_warn(hdmi->dev, "Want PLL %u Hz, got %lu Hz\n", clock,  in mtk_hdmi_video_change_vpll()
853 		dev_dbg(hdmi->dev, "Want PLL %u Hz, got %lu Hz\n", clock, rate);  in mtk_hdmi_video_change_vpll()
855 	mtk_hdmi_hw_config_sys(hdmi);  in mtk_hdmi_video_change_vpll()
856 	mtk_hdmi_hw_set_deep_color_mode(hdmi);  in mtk_hdmi_video_change_vpll()
860 static void mtk_hdmi_video_set_display_mode(struct mtk_hdmi *hdmi,  in mtk_hdmi_video_set_display_mode()  argument
863 	mtk_hdmi_hw_reset(hdmi);  in mtk_hdmi_video_set_display_mode()
864 	mtk_hdmi_hw_enable_notice(hdmi, true);  in mtk_hdmi_video_set_display_mode()
865 	mtk_hdmi_hw_write_int_mask(hdmi, 0xff);  in mtk_hdmi_video_set_display_mode()
866 	mtk_hdmi_hw_enable_dvi_mode(hdmi, hdmi->dvi_mode);  in mtk_hdmi_video_set_display_mode()
867 	mtk_hdmi_hw_ncts_auto_write_enable(hdmi, true);  in mtk_hdmi_video_set_display_mode()
869 	mtk_hdmi_hw_msic_setting(hdmi, mode);  in mtk_hdmi_video_set_display_mode()
872 static int mtk_hdmi_aud_enable_packet(struct mtk_hdmi *hdmi, bool enable)  in mtk_hdmi_aud_enable_packet()  argument
874 	mtk_hdmi_hw_send_aud_packet(hdmi, enable);  in mtk_hdmi_aud_enable_packet()
878 static int mtk_hdmi_aud_on_off_hw_ncts(struct mtk_hdmi *hdmi, bool on)  in mtk_hdmi_aud_on_off_hw_ncts()  argument
880 	mtk_hdmi_hw_ncts_enable(hdmi, on);  in mtk_hdmi_aud_on_off_hw_ncts()
884 static int mtk_hdmi_aud_set_input(struct mtk_hdmi *hdmi)  in mtk_hdmi_aud_set_input()  argument
890 	mtk_hdmi_hw_aud_set_channel_swap(hdmi, HDMI_AUD_SWAP_LFE_CC);  in mtk_hdmi_aud_set_input()
891 	mtk_hdmi_set_bits(hdmi, GRL_MIX_CTRL, MIX_CTRL_FLAT);  in mtk_hdmi_aud_set_input()
893 	if (hdmi->aud_param.aud_input_type == HDMI_AUD_INPUT_SPDIF &&  in mtk_hdmi_aud_set_input()
894 	    hdmi->aud_param.aud_codec == HDMI_AUDIO_CODING_TYPE_DST) {  in mtk_hdmi_aud_set_input()
895 		mtk_hdmi_hw_aud_set_bit_num(hdmi, HDMI_AUDIO_SAMPLE_SIZE_24);  in mtk_hdmi_aud_set_input()
896 	} else if (hdmi->aud_param.aud_i2s_fmt == HDMI_I2S_MODE_LJT_24BIT) {  in mtk_hdmi_aud_set_input()
897 		hdmi->aud_param.aud_i2s_fmt = HDMI_I2S_MODE_LJT_16BIT;  in mtk_hdmi_aud_set_input()
900 	mtk_hdmi_hw_aud_set_i2s_fmt(hdmi, hdmi->aud_param.aud_i2s_fmt);  in mtk_hdmi_aud_set_input()
901 	mtk_hdmi_hw_aud_set_bit_num(hdmi, HDMI_AUDIO_SAMPLE_SIZE_24);  in mtk_hdmi_aud_set_input()
903 	dst = ((hdmi->aud_param.aud_input_type == HDMI_AUD_INPUT_SPDIF) &&  in mtk_hdmi_aud_set_input()
904 	       (hdmi->aud_param.aud_codec == HDMI_AUDIO_CODING_TYPE_DST));  in mtk_hdmi_aud_set_input()
905 	mtk_hdmi_hw_audio_config(hdmi, dst);  in mtk_hdmi_aud_set_input()
907 	if (hdmi->aud_param.aud_input_type == HDMI_AUD_INPUT_SPDIF)  in mtk_hdmi_aud_set_input()
910 		chan_type = hdmi->aud_param.aud_input_chan_type;  in mtk_hdmi_aud_set_input()
912 	mtk_hdmi_hw_aud_set_i2s_chan_num(hdmi, chan_type, chan_count);  in mtk_hdmi_aud_set_input()
913 	mtk_hdmi_hw_aud_set_input_type(hdmi, hdmi->aud_param.aud_input_type);  in mtk_hdmi_aud_set_input()
918 static int mtk_hdmi_aud_set_src(struct mtk_hdmi *hdmi,  in mtk_hdmi_aud_set_src()  argument
921 	unsigned int sample_rate = hdmi->aud_param.codec_params.sample_rate;  in mtk_hdmi_aud_set_src()
923 	mtk_hdmi_aud_on_off_hw_ncts(hdmi, false);  in mtk_hdmi_aud_set_src()
924 	mtk_hdmi_hw_aud_src_disable(hdmi);  in mtk_hdmi_aud_set_src()
925 	mtk_hdmi_clear_bits(hdmi, GRL_CFG2, CFG2_ACLK_INV);  in mtk_hdmi_aud_set_src()
927 	if (hdmi->aud_param.aud_input_type == HDMI_AUD_INPUT_I2S) {  in mtk_hdmi_aud_set_src()
938 		mtk_hdmi_hw_aud_set_mclk(hdmi, hdmi->aud_param.aud_mclk);  in mtk_hdmi_aud_set_src()
948 		mtk_hdmi_hw_aud_set_mclk(hdmi, HDMI_AUD_MCLK_128FS);  in mtk_hdmi_aud_set_src()
951 	mtk_hdmi_hw_aud_set_ncts(hdmi, sample_rate, display_mode->clock);  in mtk_hdmi_aud_set_src()
953 	mtk_hdmi_hw_aud_src_reenable(hdmi);  in mtk_hdmi_aud_set_src()
957 static int mtk_hdmi_aud_output_config(struct mtk_hdmi *hdmi,  in mtk_hdmi_aud_output_config()  argument
960 	mtk_hdmi_hw_aud_mute(hdmi);  in mtk_hdmi_aud_output_config()
961 	mtk_hdmi_aud_enable_packet(hdmi, false);  in mtk_hdmi_aud_output_config()
963 	mtk_hdmi_aud_set_input(hdmi);  in mtk_hdmi_aud_output_config()
964 	mtk_hdmi_aud_set_src(hdmi, display_mode);  in mtk_hdmi_aud_output_config()
965 	mtk_hdmi_hw_aud_set_channel_status(hdmi,  in mtk_hdmi_aud_output_config()
966 			hdmi->aud_param.codec_params.iec.status);  in mtk_hdmi_aud_output_config()
970 	mtk_hdmi_aud_on_off_hw_ncts(hdmi, true);  in mtk_hdmi_aud_output_config()
971 	mtk_hdmi_aud_enable_packet(hdmi, true);  in mtk_hdmi_aud_output_config()
972 	mtk_hdmi_hw_aud_unmute(hdmi);  in mtk_hdmi_aud_output_config()
976 static int mtk_hdmi_setup_avi_infoframe(struct mtk_hdmi *hdmi,  in mtk_hdmi_setup_avi_infoframe()  argument
984 						       &hdmi->conn, mode);  in mtk_hdmi_setup_avi_infoframe()
986 		dev_err(hdmi->dev,  in mtk_hdmi_setup_avi_infoframe()
993 		dev_err(hdmi->dev, "Failed to pack AVI infoframe: %zd\n", err);  in mtk_hdmi_setup_avi_infoframe()
997 	mtk_hdmi_hw_send_info_frame(hdmi, buffer, sizeof(buffer));  in mtk_hdmi_setup_avi_infoframe()
1001 static int mtk_hdmi_setup_spd_infoframe(struct mtk_hdmi *hdmi,  in mtk_hdmi_setup_spd_infoframe()  argument
1011 		dev_err(hdmi->dev, "Failed to initialize SPD infoframe: %zd\n",  in mtk_hdmi_setup_spd_infoframe()
1018 		dev_err(hdmi->dev, "Failed to pack SDP infoframe: %zd\n", err);  in mtk_hdmi_setup_spd_infoframe()
1022 	mtk_hdmi_hw_send_info_frame(hdmi, buffer, sizeof(buffer));  in mtk_hdmi_setup_spd_infoframe()
1026 static int mtk_hdmi_setup_audio_infoframe(struct mtk_hdmi *hdmi)  in mtk_hdmi_setup_audio_infoframe()  argument
1034 		dev_err(hdmi->dev, "Failed to setup audio infoframe: %zd\n",  in mtk_hdmi_setup_audio_infoframe()
1043 					hdmi->aud_param.aud_input_chan_type);  in mtk_hdmi_setup_audio_infoframe()
1047 		dev_err(hdmi->dev, "Failed to pack audio infoframe: %zd\n",  in mtk_hdmi_setup_audio_infoframe()
1052 	mtk_hdmi_hw_send_info_frame(hdmi, buffer, sizeof(buffer));  in mtk_hdmi_setup_audio_infoframe()
1056 static int mtk_hdmi_setup_vendor_specific_infoframe(struct mtk_hdmi *hdmi,  in mtk_hdmi_setup_vendor_specific_infoframe()  argument
1064 							  &hdmi->conn, mode);  in mtk_hdmi_setup_vendor_specific_infoframe()
1066 		dev_err(hdmi->dev,  in mtk_hdmi_setup_vendor_specific_infoframe()
1073 		dev_err(hdmi->dev, "Failed to pack vendor infoframe: %zd\n",  in mtk_hdmi_setup_vendor_specific_infoframe()
1078 	mtk_hdmi_hw_send_info_frame(hdmi, buffer, sizeof(buffer));  in mtk_hdmi_setup_vendor_specific_infoframe()
1082 static int mtk_hdmi_output_init(struct mtk_hdmi *hdmi)  in mtk_hdmi_output_init()  argument
1084 	struct hdmi_audio_param *aud_param = &hdmi->aud_param;  in mtk_hdmi_output_init()
1086 	hdmi->csp = HDMI_COLORSPACE_RGB;  in mtk_hdmi_output_init()
1097 static void mtk_hdmi_audio_enable(struct mtk_hdmi *hdmi)  in mtk_hdmi_audio_enable()  argument
1099 	mtk_hdmi_aud_enable_packet(hdmi, true);  in mtk_hdmi_audio_enable()
1100 	hdmi->audio_enable = true;  in mtk_hdmi_audio_enable()
1103 static void mtk_hdmi_audio_disable(struct mtk_hdmi *hdmi)  in mtk_hdmi_audio_disable()  argument
1105 	mtk_hdmi_aud_enable_packet(hdmi, false);  in mtk_hdmi_audio_disable()
1106 	hdmi->audio_enable = false;  in mtk_hdmi_audio_disable()
1109 static int mtk_hdmi_audio_set_param(struct mtk_hdmi *hdmi,  in mtk_hdmi_audio_set_param()  argument
1112 	if (!hdmi->audio_enable) {  in mtk_hdmi_audio_set_param()
1113 		dev_err(hdmi->dev, "hdmi audio is in disable state!\n");  in mtk_hdmi_audio_set_param()
1116 	dev_dbg(hdmi->dev, "codec:%d, input:%d, channel:%d, fs:%d\n",  in mtk_hdmi_audio_set_param()
1119 	memcpy(&hdmi->aud_param, param, sizeof(*param));  in mtk_hdmi_audio_set_param()
1120 	return mtk_hdmi_aud_output_config(hdmi, &hdmi->mode);  in mtk_hdmi_audio_set_param()
1123 static int mtk_hdmi_output_set_display_mode(struct mtk_hdmi *hdmi,  in mtk_hdmi_output_set_display_mode()  argument
1128 	mtk_hdmi_hw_vid_black(hdmi, true);  in mtk_hdmi_output_set_display_mode()
1129 	mtk_hdmi_hw_aud_mute(hdmi);  in mtk_hdmi_output_set_display_mode()
1130 	mtk_hdmi_hw_send_av_mute(hdmi);  in mtk_hdmi_output_set_display_mode()
1131 	phy_power_off(hdmi->phy);  in mtk_hdmi_output_set_display_mode()
1133 	ret = mtk_hdmi_video_change_vpll(hdmi,  in mtk_hdmi_output_set_display_mode()
1136 		dev_err(hdmi->dev, "Failed to set vpll: %d\n", ret);  in mtk_hdmi_output_set_display_mode()
1139 	mtk_hdmi_video_set_display_mode(hdmi, mode);  in mtk_hdmi_output_set_display_mode()
1141 	phy_power_on(hdmi->phy);  in mtk_hdmi_output_set_display_mode()
1142 	mtk_hdmi_aud_output_config(hdmi, mode);  in mtk_hdmi_output_set_display_mode()
1144 	mtk_hdmi_hw_vid_black(hdmi, false);  in mtk_hdmi_output_set_display_mode()
1145 	mtk_hdmi_hw_aud_unmute(hdmi);  in mtk_hdmi_output_set_display_mode()
1146 	mtk_hdmi_hw_send_av_unmute(hdmi);  in mtk_hdmi_output_set_display_mode()
1158 static int mtk_hdmi_get_all_clk(struct mtk_hdmi *hdmi,  in mtk_hdmi_get_all_clk()  argument
1164 		hdmi->clk[i] = of_clk_get_by_name(np,  in mtk_hdmi_get_all_clk()
1166 		if (IS_ERR(hdmi->clk[i]))  in mtk_hdmi_get_all_clk()
1167 			return PTR_ERR(hdmi->clk[i]);  in mtk_hdmi_get_all_clk()
1172 static int mtk_hdmi_clk_enable_audio(struct mtk_hdmi *hdmi)  in mtk_hdmi_clk_enable_audio()  argument
1176 	ret = clk_prepare_enable(hdmi->clk[MTK_HDMI_CLK_AUD_BCLK]);  in mtk_hdmi_clk_enable_audio()
1180 	ret = clk_prepare_enable(hdmi->clk[MTK_HDMI_CLK_AUD_SPDIF]);  in mtk_hdmi_clk_enable_audio()
1186 	clk_disable_unprepare(hdmi->clk[MTK_HDMI_CLK_AUD_BCLK]);  in mtk_hdmi_clk_enable_audio()
1190 static void mtk_hdmi_clk_disable_audio(struct mtk_hdmi *hdmi)  in mtk_hdmi_clk_disable_audio()  argument
1192 	clk_disable_unprepare(hdmi->clk[MTK_HDMI_CLK_AUD_BCLK]);  in mtk_hdmi_clk_disable_audio()
1193 	clk_disable_unprepare(hdmi->clk[MTK_HDMI_CLK_AUD_SPDIF]);  in mtk_hdmi_clk_disable_audio()
1199 	struct mtk_hdmi *hdmi = hdmi_ctx_from_conn(conn);  in hdmi_conn_detect()  local
1201 	return mtk_cec_hpd_high(hdmi->cec_dev) ?  in hdmi_conn_detect()
1207 	struct mtk_hdmi *hdmi = hdmi_ctx_from_conn(conn);  in hdmi_conn_destroy()  local
1209 	mtk_cec_set_hpd_event(hdmi->cec_dev, NULL, NULL);  in hdmi_conn_destroy()
1216 	struct mtk_hdmi *hdmi = hdmi_ctx_from_conn(conn);  in mtk_hdmi_conn_get_modes()  local
1220 	if (!hdmi->ddc_adpt)  in mtk_hdmi_conn_get_modes()
1223 	edid = drm_get_edid(conn, hdmi->ddc_adpt);  in mtk_hdmi_conn_get_modes()
1227 	hdmi->dvi_mode = !drm_detect_monitor_audio(edid);  in mtk_hdmi_conn_get_modes()
1239 	struct mtk_hdmi *hdmi = hdmi_ctx_from_conn(conn);  in mtk_hdmi_conn_mode_valid()  local
1241 	dev_dbg(hdmi->dev, "xres=%d, yres=%d, refresh=%d, intl=%d clock=%d\n",  in mtk_hdmi_conn_mode_valid()
1245 	if (hdmi->bridge.next) {  in mtk_hdmi_conn_mode_valid()
1249 		if (!drm_bridge_mode_fixup(hdmi->bridge.next, mode,  in mtk_hdmi_conn_mode_valid()
1264 	struct mtk_hdmi *hdmi = hdmi_ctx_from_conn(conn);  in mtk_hdmi_conn_best_enc()  local
1266 	return hdmi->bridge.encoder;  in mtk_hdmi_conn_best_enc()
1287 	struct mtk_hdmi *hdmi = dev_get_drvdata(dev);  in mtk_hdmi_hpd_event()  local
1289 	if (hdmi && hdmi->bridge.encoder && hdmi->bridge.encoder->dev)  in mtk_hdmi_hpd_event()
1290 		drm_helper_hpd_irq_event(hdmi->bridge.encoder->dev);  in mtk_hdmi_hpd_event()
1299 	struct mtk_hdmi *hdmi = hdmi_ctx_from_bridge(bridge);  in mtk_hdmi_bridge_attach()  local
1302 	ret = drm_connector_init(bridge->encoder->dev, &hdmi->conn,  in mtk_hdmi_bridge_attach()
1306 		dev_err(hdmi->dev, "Failed to initialize connector: %d\n", ret);  in mtk_hdmi_bridge_attach()
1309 	drm_connector_helper_add(&hdmi->conn, &mtk_hdmi_connector_helper_funcs);  in mtk_hdmi_bridge_attach()
1311 	hdmi->conn.polled = DRM_CONNECTOR_POLL_HPD;  in mtk_hdmi_bridge_attach()
1312 	hdmi->conn.interlace_allowed = true;  in mtk_hdmi_bridge_attach()
1313 	hdmi->conn.doublescan_allowed = false;  in mtk_hdmi_bridge_attach()
1315 	ret = drm_connector_attach_encoder(&hdmi->conn,  in mtk_hdmi_bridge_attach()
1318 		dev_err(hdmi->dev,  in mtk_hdmi_bridge_attach()
1323 	if (hdmi->next_bridge) {  in mtk_hdmi_bridge_attach()
1324 		ret = drm_bridge_attach(bridge->encoder, hdmi->next_bridge,  in mtk_hdmi_bridge_attach()
1327 			dev_err(hdmi->dev,  in mtk_hdmi_bridge_attach()
1333 	mtk_cec_set_hpd_event(hdmi->cec_dev, mtk_hdmi_hpd_event, hdmi->dev);  in mtk_hdmi_bridge_attach()
1347 	struct mtk_hdmi *hdmi = hdmi_ctx_from_bridge(bridge);  in mtk_hdmi_bridge_disable()  local
1349 	if (!hdmi->enabled)  in mtk_hdmi_bridge_disable()
1352 	phy_power_off(hdmi->phy);  in mtk_hdmi_bridge_disable()
1353 	clk_disable_unprepare(hdmi->clk[MTK_HDMI_CLK_HDMI_PIXEL]);  in mtk_hdmi_bridge_disable()
1354 	clk_disable_unprepare(hdmi->clk[MTK_HDMI_CLK_HDMI_PLL]);  in mtk_hdmi_bridge_disable()
1356 	hdmi->enabled = false;  in mtk_hdmi_bridge_disable()
1361 	struct mtk_hdmi *hdmi = hdmi_ctx_from_bridge(bridge);  in mtk_hdmi_bridge_post_disable()  local
1363 	if (!hdmi->powered)  in mtk_hdmi_bridge_post_disable()
1366 	mtk_hdmi_hw_1p4_version_enable(hdmi, true);  in mtk_hdmi_bridge_post_disable()
1367 	mtk_hdmi_hw_make_reg_writable(hdmi, false);  in mtk_hdmi_bridge_post_disable()
1369 	hdmi->powered = false;  in mtk_hdmi_bridge_post_disable()
1376 	struct mtk_hdmi *hdmi = hdmi_ctx_from_bridge(bridge);  in mtk_hdmi_bridge_mode_set()  local
1378 	dev_dbg(hdmi->dev, "cur info: name:%s, hdisplay:%d\n",  in mtk_hdmi_bridge_mode_set()
1380 	dev_dbg(hdmi->dev, "hsync_start:%d,hsync_end:%d, htotal:%d",  in mtk_hdmi_bridge_mode_set()
1383 	dev_dbg(hdmi->dev, "hskew:%d, vdisplay:%d\n",  in mtk_hdmi_bridge_mode_set()
1385 	dev_dbg(hdmi->dev, "vsync_start:%d, vsync_end:%d, vtotal:%d",  in mtk_hdmi_bridge_mode_set()
1388 	dev_dbg(hdmi->dev, "vscan:%d, flag:%d\n",  in mtk_hdmi_bridge_mode_set()
1391 	drm_mode_copy(&hdmi->mode, adjusted_mode);  in mtk_hdmi_bridge_mode_set()
1396 	struct mtk_hdmi *hdmi = hdmi_ctx_from_bridge(bridge);  in mtk_hdmi_bridge_pre_enable()  local
1398 	mtk_hdmi_hw_make_reg_writable(hdmi, true);  in mtk_hdmi_bridge_pre_enable()
1399 	mtk_hdmi_hw_1p4_version_enable(hdmi, true);  in mtk_hdmi_bridge_pre_enable()
1401 	hdmi->powered = true;  in mtk_hdmi_bridge_pre_enable()
1404 static void mtk_hdmi_send_infoframe(struct mtk_hdmi *hdmi,  in mtk_hdmi_send_infoframe()  argument
1407 	mtk_hdmi_setup_audio_infoframe(hdmi);  in mtk_hdmi_send_infoframe()
1408 	mtk_hdmi_setup_avi_infoframe(hdmi, mode);  in mtk_hdmi_send_infoframe()
1409 	mtk_hdmi_setup_spd_infoframe(hdmi, "mediatek", "On-chip HDMI");  in mtk_hdmi_send_infoframe()
1411 		mtk_hdmi_setup_vendor_specific_infoframe(hdmi, mode);  in mtk_hdmi_send_infoframe()
1416 	struct mtk_hdmi *hdmi = hdmi_ctx_from_bridge(bridge);  in mtk_hdmi_bridge_enable()  local
1418 	mtk_hdmi_output_set_display_mode(hdmi, &hdmi->mode);  in mtk_hdmi_bridge_enable()
1419 	clk_prepare_enable(hdmi->clk[MTK_HDMI_CLK_HDMI_PLL]);  in mtk_hdmi_bridge_enable()
1420 	clk_prepare_enable(hdmi->clk[MTK_HDMI_CLK_HDMI_PIXEL]);  in mtk_hdmi_bridge_enable()
1421 	phy_power_on(hdmi->phy);  in mtk_hdmi_bridge_enable()
1422 	mtk_hdmi_send_infoframe(hdmi, &hdmi->mode);  in mtk_hdmi_bridge_enable()
1424 	hdmi->enabled = true;  in mtk_hdmi_bridge_enable()
1437 static int mtk_hdmi_dt_parse_pdata(struct mtk_hdmi *hdmi,  in mtk_hdmi_dt_parse_pdata()  argument
1448 	ret = mtk_hdmi_get_all_clk(hdmi, np);  in mtk_hdmi_dt_parse_pdata()
1463 		dev_err(hdmi->dev, "Waiting for CEC device %pOF\n",  in mtk_hdmi_dt_parse_pdata()
1469 	hdmi->cec_dev = &cec_pdev->dev;  in mtk_hdmi_dt_parse_pdata()
1478 					 &hdmi->sys_offset);  in mtk_hdmi_dt_parse_pdata()
1487 	hdmi->sys_regmap = regmap;  in mtk_hdmi_dt_parse_pdata()
1490 	hdmi->regs = devm_ioremap_resource(dev, mem);  in mtk_hdmi_dt_parse_pdata()
1491 	if (IS_ERR(hdmi->regs))  in mtk_hdmi_dt_parse_pdata()
1492 		return PTR_ERR(hdmi->regs);  in mtk_hdmi_dt_parse_pdata()
1499 		hdmi->next_bridge = of_drm_find_bridge(remote);  in mtk_hdmi_dt_parse_pdata()
1500 		if (!hdmi->next_bridge) {  in mtk_hdmi_dt_parse_pdata()
1516 	hdmi->ddc_adpt = of_find_i2c_adapter_by_node(i2c_np);  in mtk_hdmi_dt_parse_pdata()
1518 	if (!hdmi->ddc_adpt) {  in mtk_hdmi_dt_parse_pdata()
1534 	struct mtk_hdmi *hdmi = dev_get_drvdata(dev);  in mtk_hdmi_audio_hw_params()  local
1538 	dev_dbg(hdmi->dev, "%s: %u Hz, %d bit, %d channels\n", __func__,  in mtk_hdmi_audio_hw_params()
1541 	if (!hdmi->bridge.encoder)  in mtk_hdmi_audio_hw_params()
1558 		dev_err(hdmi->dev, "channel[%d] not supported!\n", chan);  in mtk_hdmi_audio_hw_params()
1572 		dev_err(hdmi->dev, "rate[%d] not supported!\n",  in mtk_hdmi_audio_hw_params()
1591 		dev_err(hdmi->dev, "%s: Invalid DAI format %d\n", __func__,  in mtk_hdmi_audio_hw_params()
1599 	mtk_hdmi_audio_set_param(hdmi, &hdmi_params);  in mtk_hdmi_audio_hw_params()
1606 	struct mtk_hdmi *hdmi = dev_get_drvdata(dev);  in mtk_hdmi_audio_startup()  local
1610 	mtk_hdmi_audio_enable(hdmi);  in mtk_hdmi_audio_startup()
1617 	struct mtk_hdmi *hdmi = dev_get_drvdata(dev);  in mtk_hdmi_audio_shutdown()  local
1621 	mtk_hdmi_audio_disable(hdmi);  in mtk_hdmi_audio_shutdown()
1627 	struct mtk_hdmi *hdmi = dev_get_drvdata(dev);  in mtk_hdmi_audio_digital_mute()  local
1632 		mtk_hdmi_hw_aud_mute(hdmi);  in mtk_hdmi_audio_digital_mute()
1634 		mtk_hdmi_hw_aud_unmute(hdmi);  in mtk_hdmi_audio_digital_mute()
1641 	struct mtk_hdmi *hdmi = dev_get_drvdata(dev);  in mtk_hdmi_audio_get_eld()  local
1645 	memcpy(buf, hdmi->conn.eld, min(sizeof(hdmi->conn.eld), len));  in mtk_hdmi_audio_get_eld()
1678 	struct mtk_hdmi *hdmi;  in mtk_drm_hdmi_probe()  local
1682 	hdmi = devm_kzalloc(dev, sizeof(*hdmi), GFP_KERNEL);  in mtk_drm_hdmi_probe()
1683 	if (!hdmi)  in mtk_drm_hdmi_probe()
1686 	hdmi->dev = dev;  in mtk_drm_hdmi_probe()
1688 	ret = mtk_hdmi_dt_parse_pdata(hdmi, pdev);  in mtk_drm_hdmi_probe()
1692 	hdmi->phy = devm_phy_get(dev, "hdmi");  in mtk_drm_hdmi_probe()
1693 	if (IS_ERR(hdmi->phy)) {  in mtk_drm_hdmi_probe()
1694 		ret = PTR_ERR(hdmi->phy);  in mtk_drm_hdmi_probe()
1699 	platform_set_drvdata(pdev, hdmi);  in mtk_drm_hdmi_probe()
1701 	ret = mtk_hdmi_output_init(hdmi);  in mtk_drm_hdmi_probe()
1709 	hdmi->bridge.funcs = &mtk_hdmi_bridge_funcs;  in mtk_drm_hdmi_probe()
1710 	hdmi->bridge.of_node = pdev->dev.of_node;  in mtk_drm_hdmi_probe()
1711 	drm_bridge_add(&hdmi->bridge);  in mtk_drm_hdmi_probe()
1713 	ret = mtk_hdmi_clk_enable_audio(hdmi);  in mtk_drm_hdmi_probe()
1723 	drm_bridge_remove(&hdmi->bridge);  in mtk_drm_hdmi_probe()
1729 	struct mtk_hdmi *hdmi = platform_get_drvdata(pdev);  in mtk_drm_hdmi_remove()  local
1731 	drm_bridge_remove(&hdmi->bridge);  in mtk_drm_hdmi_remove()
1732 	mtk_hdmi_clk_disable_audio(hdmi);  in mtk_drm_hdmi_remove()
1739 	struct mtk_hdmi *hdmi = dev_get_drvdata(dev);  in mtk_hdmi_suspend()  local
1741 	mtk_hdmi_clk_disable_audio(hdmi);  in mtk_hdmi_suspend()
1748 	struct mtk_hdmi *hdmi = dev_get_drvdata(dev);  in mtk_hdmi_resume()  local
1751 	ret = mtk_hdmi_clk_enable_audio(hdmi);  in mtk_hdmi_resume()