Lines Matching full:hdmi
12 #include <linux/hdmi.h>
158 static inline u8 hdmi_readb(struct inno_hdmi *hdmi, u16 offset) in hdmi_readb() argument
160 return readl_relaxed(hdmi->regs + (offset) * 0x04); in hdmi_readb()
163 static inline void hdmi_writeb(struct inno_hdmi *hdmi, u16 offset, u32 val) in hdmi_writeb() argument
165 writel_relaxed(val, hdmi->regs + (offset) * 0x04); in hdmi_writeb()
168 static inline void hdmi_modb(struct inno_hdmi *hdmi, u16 offset, in hdmi_modb() argument
171 u8 temp = hdmi_readb(hdmi, offset) & ~msk; in hdmi_modb()
174 hdmi_writeb(hdmi, offset, temp); in hdmi_modb()
177 static void inno_hdmi_i2c_init(struct inno_hdmi *hdmi) in inno_hdmi_i2c_init() argument
181 ddc_bus_freq = (hdmi->tmds_rate >> 2) / HDMI_SCL_RATE; in inno_hdmi_i2c_init()
183 hdmi_writeb(hdmi, DDC_BUS_FREQ_L, ddc_bus_freq & 0xFF); in inno_hdmi_i2c_init()
184 hdmi_writeb(hdmi, DDC_BUS_FREQ_H, (ddc_bus_freq >> 8) & 0xFF); in inno_hdmi_i2c_init()
187 hdmi_writeb(hdmi, HDMI_INTERRUPT_MASK1, 0); in inno_hdmi_i2c_init()
188 hdmi_writeb(hdmi, HDMI_INTERRUPT_STATUS1, m_INT_EDID_READY); in inno_hdmi_i2c_init()
191 static void inno_hdmi_sys_power(struct inno_hdmi *hdmi, bool enable) in inno_hdmi_sys_power() argument
194 hdmi_modb(hdmi, HDMI_SYS_CTRL, m_POWER, v_PWR_ON); in inno_hdmi_sys_power()
196 hdmi_modb(hdmi, HDMI_SYS_CTRL, m_POWER, v_PWR_OFF); in inno_hdmi_sys_power()
199 static void inno_hdmi_set_pwr_mode(struct inno_hdmi *hdmi, int mode) in inno_hdmi_set_pwr_mode() argument
203 inno_hdmi_sys_power(hdmi, false); in inno_hdmi_set_pwr_mode()
205 hdmi_writeb(hdmi, HDMI_PHY_PRE_EMPHASIS, 0x6f); in inno_hdmi_set_pwr_mode()
206 hdmi_writeb(hdmi, HDMI_PHY_DRIVER, 0xbb); in inno_hdmi_set_pwr_mode()
208 hdmi_writeb(hdmi, HDMI_PHY_SYS_CTL, 0x15); in inno_hdmi_set_pwr_mode()
209 hdmi_writeb(hdmi, HDMI_PHY_SYS_CTL, 0x14); in inno_hdmi_set_pwr_mode()
210 hdmi_writeb(hdmi, HDMI_PHY_SYS_CTL, 0x10); in inno_hdmi_set_pwr_mode()
211 hdmi_writeb(hdmi, HDMI_PHY_CHG_PWR, 0x0f); in inno_hdmi_set_pwr_mode()
212 hdmi_writeb(hdmi, HDMI_PHY_SYNC, 0x00); in inno_hdmi_set_pwr_mode()
213 hdmi_writeb(hdmi, HDMI_PHY_SYNC, 0x01); in inno_hdmi_set_pwr_mode()
215 inno_hdmi_sys_power(hdmi, true); in inno_hdmi_set_pwr_mode()
219 inno_hdmi_sys_power(hdmi, false); in inno_hdmi_set_pwr_mode()
220 hdmi_writeb(hdmi, HDMI_PHY_DRIVER, 0x00); in inno_hdmi_set_pwr_mode()
221 hdmi_writeb(hdmi, HDMI_PHY_PRE_EMPHASIS, 0x00); in inno_hdmi_set_pwr_mode()
222 hdmi_writeb(hdmi, HDMI_PHY_CHG_PWR, 0x00); in inno_hdmi_set_pwr_mode()
223 hdmi_writeb(hdmi, HDMI_PHY_SYS_CTL, 0x15); in inno_hdmi_set_pwr_mode()
228 DRM_DEV_ERROR(hdmi->dev, "Unknown power mode %d\n", mode); in inno_hdmi_set_pwr_mode()
232 static void inno_hdmi_reset(struct inno_hdmi *hdmi) in inno_hdmi_reset() argument
237 hdmi_modb(hdmi, HDMI_SYS_CTRL, m_RST_DIGITAL, v_NOT_RST_DIGITAL); in inno_hdmi_reset()
240 hdmi_modb(hdmi, HDMI_SYS_CTRL, m_RST_ANALOG, v_NOT_RST_ANALOG); in inno_hdmi_reset()
245 hdmi_modb(hdmi, HDMI_SYS_CTRL, msk, val); in inno_hdmi_reset()
247 inno_hdmi_set_pwr_mode(hdmi, NORMAL); in inno_hdmi_reset()
250 static int inno_hdmi_upload_frame(struct inno_hdmi *hdmi, int setup_rc, in inno_hdmi_upload_frame() argument
255 hdmi_modb(hdmi, HDMI_PACKET_SEND_AUTO, mask, disable); in inno_hdmi_upload_frame()
257 hdmi_writeb(hdmi, HDMI_CONTROL_PACKET_BUF_INDEX, frame_index); in inno_hdmi_upload_frame()
269 hdmi_writeb(hdmi, HDMI_CONTROL_PACKET_ADDR + i, in inno_hdmi_upload_frame()
273 hdmi_modb(hdmi, HDMI_PACKET_SEND_AUTO, mask, enable); in inno_hdmi_upload_frame()
279 static int inno_hdmi_config_video_vsi(struct inno_hdmi *hdmi, in inno_hdmi_config_video_vsi() argument
285 rc = drm_hdmi_vendor_infoframe_from_display_mode(&frame.vendor.hdmi, in inno_hdmi_config_video_vsi()
286 &hdmi->connector, in inno_hdmi_config_video_vsi()
289 return inno_hdmi_upload_frame(hdmi, rc, &frame, INFOFRAME_VSI, in inno_hdmi_config_video_vsi()
293 static int inno_hdmi_config_video_avi(struct inno_hdmi *hdmi, in inno_hdmi_config_video_avi() argument
300 &hdmi->connector, in inno_hdmi_config_video_avi()
303 if (hdmi->hdmi_data.enc_out_format == HDMI_COLORSPACE_YUV444) in inno_hdmi_config_video_avi()
305 else if (hdmi->hdmi_data.enc_out_format == HDMI_COLORSPACE_YUV422) in inno_hdmi_config_video_avi()
310 return inno_hdmi_upload_frame(hdmi, rc, &frame, INFOFRAME_AVI, 0, 0, 0); in inno_hdmi_config_video_avi()
313 static int inno_hdmi_config_video_csc(struct inno_hdmi *hdmi) in inno_hdmi_config_video_csc() argument
315 struct hdmi_data_info *data = &hdmi->hdmi_data; in inno_hdmi_config_video_csc()
324 hdmi_writeb(hdmi, HDMI_VIDEO_CONTRL1, v_DE_EXTERNAL | in inno_hdmi_config_video_csc()
331 hdmi_writeb(hdmi, HDMI_VIDEO_CONTRL2, value); in inno_hdmi_config_video_csc()
337 hdmi_writeb(hdmi, HDMI_VIDEO_CONTRL3, value); in inno_hdmi_config_video_csc()
339 hdmi_modb(hdmi, HDMI_VIDEO_CONTRL, in inno_hdmi_config_video_csc()
378 hdmi_writeb(hdmi, HDMI_VIDEO_CSC_COEF + i, in inno_hdmi_config_video_csc()
382 hdmi_writeb(hdmi, HDMI_VIDEO_CONTRL3, value); in inno_hdmi_config_video_csc()
383 hdmi_modb(hdmi, HDMI_VIDEO_CONTRL, m_VIDEO_AUTO_CSC | in inno_hdmi_config_video_csc()
390 static int inno_hdmi_config_video_timing(struct inno_hdmi *hdmi, in inno_hdmi_config_video_timing() argument
403 hdmi_writeb(hdmi, HDMI_VIDEO_TIMING_CTL, value); in inno_hdmi_config_video_timing()
407 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_HTOTAL_L, value & 0xFF); in inno_hdmi_config_video_timing()
408 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_HTOTAL_H, (value >> 8) & 0xFF); in inno_hdmi_config_video_timing()
411 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_HBLANK_L, value & 0xFF); in inno_hdmi_config_video_timing()
412 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_HBLANK_H, (value >> 8) & 0xFF); in inno_hdmi_config_video_timing()
415 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_HDELAY_L, value & 0xFF); in inno_hdmi_config_video_timing()
416 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_HDELAY_H, (value >> 8) & 0xFF); in inno_hdmi_config_video_timing()
419 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_HDURATION_L, value & 0xFF); in inno_hdmi_config_video_timing()
420 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_HDURATION_H, (value >> 8) & 0xFF); in inno_hdmi_config_video_timing()
423 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_VTOTAL_L, value & 0xFF); in inno_hdmi_config_video_timing()
424 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_VTOTAL_H, (value >> 8) & 0xFF); in inno_hdmi_config_video_timing()
427 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_VBLANK, value & 0xFF); in inno_hdmi_config_video_timing()
430 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_VDELAY, value & 0xFF); in inno_hdmi_config_video_timing()
433 hdmi_writeb(hdmi, HDMI_VIDEO_EXT_VDURATION, value & 0xFF); in inno_hdmi_config_video_timing()
435 hdmi_writeb(hdmi, HDMI_PHY_PRE_DIV_RATIO, 0x1e); in inno_hdmi_config_video_timing()
436 hdmi_writeb(hdmi, HDMI_PHY_FEEDBACK_DIV_RATIO_LOW, 0x2c); in inno_hdmi_config_video_timing()
437 hdmi_writeb(hdmi, HDMI_PHY_FEEDBACK_DIV_RATIO_HIGH, 0x01); in inno_hdmi_config_video_timing()
442 static int inno_hdmi_setup(struct inno_hdmi *hdmi, in inno_hdmi_setup() argument
445 struct drm_display_info *display = &hdmi->connector.display_info; in inno_hdmi_setup()
447 hdmi->hdmi_data.vic = drm_match_cea_mode(mode); in inno_hdmi_setup()
449 hdmi->hdmi_data.enc_in_format = HDMI_COLORSPACE_RGB; in inno_hdmi_setup()
450 hdmi->hdmi_data.enc_out_format = HDMI_COLORSPACE_RGB; in inno_hdmi_setup()
452 if ((hdmi->hdmi_data.vic == 6) || (hdmi->hdmi_data.vic == 7) || in inno_hdmi_setup()
453 (hdmi->hdmi_data.vic == 21) || (hdmi->hdmi_data.vic == 22) || in inno_hdmi_setup()
454 (hdmi->hdmi_data.vic == 2) || (hdmi->hdmi_data.vic == 3) || in inno_hdmi_setup()
455 (hdmi->hdmi_data.vic == 17) || (hdmi->hdmi_data.vic == 18)) in inno_hdmi_setup()
456 hdmi->hdmi_data.colorimetry = HDMI_COLORIMETRY_ITU_601; in inno_hdmi_setup()
458 hdmi->hdmi_data.colorimetry = HDMI_COLORIMETRY_ITU_709; in inno_hdmi_setup()
461 hdmi_modb(hdmi, HDMI_AV_MUTE, m_AUDIO_MUTE | m_VIDEO_BLACK, in inno_hdmi_setup()
464 /* Set HDMI Mode */ in inno_hdmi_setup()
465 hdmi_writeb(hdmi, HDMI_HDCP_CTRL, in inno_hdmi_setup()
468 inno_hdmi_config_video_timing(hdmi, mode); in inno_hdmi_setup()
470 inno_hdmi_config_video_csc(hdmi); in inno_hdmi_setup()
473 inno_hdmi_config_video_avi(hdmi, mode); in inno_hdmi_setup()
474 inno_hdmi_config_video_vsi(hdmi, mode); in inno_hdmi_setup()
483 hdmi->tmds_rate = mode->clock * 1000; in inno_hdmi_setup()
484 inno_hdmi_i2c_init(hdmi); in inno_hdmi_setup()
487 hdmi_modb(hdmi, HDMI_AV_MUTE, m_AUDIO_MUTE | m_VIDEO_BLACK, in inno_hdmi_setup()
497 struct inno_hdmi *hdmi = encoder_to_inno_hdmi(encoder); in inno_hdmi_encoder_mode_set() local
499 inno_hdmi_setup(hdmi, adj_mode); in inno_hdmi_encoder_mode_set()
502 drm_mode_copy(&hdmi->previous_mode, adj_mode); in inno_hdmi_encoder_mode_set()
507 struct inno_hdmi *hdmi = encoder_to_inno_hdmi(encoder); in inno_hdmi_encoder_enable() local
509 inno_hdmi_set_pwr_mode(hdmi, NORMAL); in inno_hdmi_encoder_enable()
514 struct inno_hdmi *hdmi = encoder_to_inno_hdmi(encoder); in inno_hdmi_encoder_disable() local
516 inno_hdmi_set_pwr_mode(hdmi, LOWER_PWR); in inno_hdmi_encoder_disable()
550 struct inno_hdmi *hdmi = connector_to_inno_hdmi(connector); in inno_hdmi_connector_detect() local
552 return (hdmi_readb(hdmi, HDMI_STATUS) & m_HOTPLUG) ? in inno_hdmi_connector_detect()
558 struct inno_hdmi *hdmi = connector_to_inno_hdmi(connector); in inno_hdmi_connector_get_modes() local
562 if (!hdmi->ddc) in inno_hdmi_connector_get_modes()
565 edid = drm_get_edid(connector, hdmi->ddc); in inno_hdmi_connector_get_modes()
567 hdmi->hdmi_data.sink_has_audio = drm_detect_monitor_audio(edid); in inno_hdmi_connector_get_modes()
610 static int inno_hdmi_register(struct drm_device *drm, struct inno_hdmi *hdmi) in inno_hdmi_register() argument
612 struct drm_encoder *encoder = &hdmi->encoder.encoder; in inno_hdmi_register()
613 struct device *dev = hdmi->dev; in inno_hdmi_register()
629 hdmi->connector.polled = DRM_CONNECTOR_POLL_HPD; in inno_hdmi_register()
631 drm_connector_helper_add(&hdmi->connector, in inno_hdmi_register()
633 drm_connector_init_with_ddc(drm, &hdmi->connector, in inno_hdmi_register()
636 hdmi->ddc); in inno_hdmi_register()
638 drm_connector_attach_encoder(&hdmi->connector, encoder); in inno_hdmi_register()
643 static irqreturn_t inno_hdmi_i2c_irq(struct inno_hdmi *hdmi) in inno_hdmi_i2c_irq() argument
645 struct inno_hdmi_i2c *i2c = hdmi->i2c; in inno_hdmi_i2c_irq()
648 stat = hdmi_readb(hdmi, HDMI_INTERRUPT_STATUS1); in inno_hdmi_i2c_irq()
652 /* Clear HDMI EDID interrupt flag */ in inno_hdmi_i2c_irq()
653 hdmi_writeb(hdmi, HDMI_INTERRUPT_STATUS1, m_INT_EDID_READY); in inno_hdmi_i2c_irq()
662 struct inno_hdmi *hdmi = dev_id; in inno_hdmi_hardirq() local
666 if (hdmi->i2c) in inno_hdmi_hardirq()
667 ret = inno_hdmi_i2c_irq(hdmi); in inno_hdmi_hardirq()
669 interrupt = hdmi_readb(hdmi, HDMI_STATUS); in inno_hdmi_hardirq()
671 hdmi_modb(hdmi, HDMI_STATUS, m_INT_HOTPLUG, m_INT_HOTPLUG); in inno_hdmi_hardirq()
680 struct inno_hdmi *hdmi = dev_id; in inno_hdmi_irq() local
682 drm_helper_hpd_irq_event(hdmi->connector.dev); in inno_hdmi_irq()
687 static int inno_hdmi_i2c_read(struct inno_hdmi *hdmi, struct i2c_msg *msgs) in inno_hdmi_i2c_read() argument
693 ret = wait_for_completion_timeout(&hdmi->i2c->cmp, HZ / 10); in inno_hdmi_i2c_read()
698 *buf++ = hdmi_readb(hdmi, HDMI_EDID_FIFO_ADDR); in inno_hdmi_i2c_read()
703 static int inno_hdmi_i2c_write(struct inno_hdmi *hdmi, struct i2c_msg *msgs) in inno_hdmi_i2c_write() argument
714 reinit_completion(&hdmi->i2c->cmp); in inno_hdmi_i2c_write()
717 hdmi->i2c->segment_addr = msgs->buf[0]; in inno_hdmi_i2c_write()
719 hdmi->i2c->ddc_addr = msgs->buf[0]; in inno_hdmi_i2c_write()
722 hdmi_writeb(hdmi, HDMI_EDID_FIFO_OFFSET, 0x00); in inno_hdmi_i2c_write()
725 hdmi_writeb(hdmi, HDMI_EDID_WORD_ADDR, hdmi->i2c->ddc_addr); in inno_hdmi_i2c_write()
728 hdmi_writeb(hdmi, HDMI_EDID_SEGMENT_POINTER, hdmi->i2c->segment_addr); in inno_hdmi_i2c_write()
736 struct inno_hdmi *hdmi = i2c_get_adapdata(adap); in inno_hdmi_i2c_xfer() local
737 struct inno_hdmi_i2c *i2c = hdmi->i2c; in inno_hdmi_i2c_xfer()
743 hdmi_writeb(hdmi, HDMI_INTERRUPT_MASK1, m_INT_EDID_READY); in inno_hdmi_i2c_xfer()
744 hdmi_writeb(hdmi, HDMI_INTERRUPT_STATUS1, m_INT_EDID_READY); in inno_hdmi_i2c_xfer()
747 DRM_DEV_DEBUG(hdmi->dev, in inno_hdmi_i2c_xfer()
752 ret = inno_hdmi_i2c_read(hdmi, &msgs[i]); in inno_hdmi_i2c_xfer()
754 ret = inno_hdmi_i2c_write(hdmi, &msgs[i]); in inno_hdmi_i2c_xfer()
763 /* Mute HDMI EDID interrupt */ in inno_hdmi_i2c_xfer()
764 hdmi_writeb(hdmi, HDMI_INTERRUPT_MASK1, 0); in inno_hdmi_i2c_xfer()
781 static struct i2c_adapter *inno_hdmi_i2c_adapter(struct inno_hdmi *hdmi) in inno_hdmi_i2c_adapter() argument
787 i2c = devm_kzalloc(hdmi->dev, sizeof(*i2c), GFP_KERNEL); in inno_hdmi_i2c_adapter()
797 adap->dev.parent = hdmi->dev; in inno_hdmi_i2c_adapter()
798 adap->dev.of_node = hdmi->dev->of_node; in inno_hdmi_i2c_adapter()
800 strscpy(adap->name, "Inno HDMI", sizeof(adap->name)); in inno_hdmi_i2c_adapter()
801 i2c_set_adapdata(adap, hdmi); in inno_hdmi_i2c_adapter()
805 dev_warn(hdmi->dev, "cannot add %s I2C adapter\n", adap->name); in inno_hdmi_i2c_adapter()
806 devm_kfree(hdmi->dev, i2c); in inno_hdmi_i2c_adapter()
810 hdmi->i2c = i2c; in inno_hdmi_i2c_adapter()
812 DRM_DEV_INFO(hdmi->dev, "registered %s I2C bus driver\n", adap->name); in inno_hdmi_i2c_adapter()
822 struct inno_hdmi *hdmi; in inno_hdmi_bind() local
826 hdmi = devm_kzalloc(dev, sizeof(*hdmi), GFP_KERNEL); in inno_hdmi_bind()
827 if (!hdmi) in inno_hdmi_bind()
830 hdmi->dev = dev; in inno_hdmi_bind()
831 hdmi->drm_dev = drm; in inno_hdmi_bind()
833 hdmi->regs = devm_platform_ioremap_resource(pdev, 0); in inno_hdmi_bind()
834 if (IS_ERR(hdmi->regs)) in inno_hdmi_bind()
835 return PTR_ERR(hdmi->regs); in inno_hdmi_bind()
837 hdmi->pclk = devm_clk_get(hdmi->dev, "pclk"); in inno_hdmi_bind()
838 if (IS_ERR(hdmi->pclk)) { in inno_hdmi_bind()
839 DRM_DEV_ERROR(hdmi->dev, "Unable to get HDMI pclk clk\n"); in inno_hdmi_bind()
840 return PTR_ERR(hdmi->pclk); in inno_hdmi_bind()
843 ret = clk_prepare_enable(hdmi->pclk); in inno_hdmi_bind()
845 DRM_DEV_ERROR(hdmi->dev, in inno_hdmi_bind()
846 "Cannot enable HDMI pclk clock: %d\n", ret); in inno_hdmi_bind()
856 inno_hdmi_reset(hdmi); in inno_hdmi_bind()
858 hdmi->ddc = inno_hdmi_i2c_adapter(hdmi); in inno_hdmi_bind()
859 if (IS_ERR(hdmi->ddc)) { in inno_hdmi_bind()
860 ret = PTR_ERR(hdmi->ddc); in inno_hdmi_bind()
861 hdmi->ddc = NULL; in inno_hdmi_bind()
871 hdmi->tmds_rate = clk_get_rate(hdmi->pclk); in inno_hdmi_bind()
872 inno_hdmi_i2c_init(hdmi); in inno_hdmi_bind()
874 ret = inno_hdmi_register(drm, hdmi); in inno_hdmi_bind()
878 dev_set_drvdata(dev, hdmi); in inno_hdmi_bind()
881 hdmi_modb(hdmi, HDMI_STATUS, m_MASK_INT_HOTPLUG, v_MASK_INT_HOTPLUG(1)); in inno_hdmi_bind()
885 dev_name(dev), hdmi); in inno_hdmi_bind()
891 hdmi->connector.funcs->destroy(&hdmi->connector); in inno_hdmi_bind()
892 hdmi->encoder.encoder.funcs->destroy(&hdmi->encoder.encoder); in inno_hdmi_bind()
894 i2c_put_adapter(hdmi->ddc); in inno_hdmi_bind()
896 clk_disable_unprepare(hdmi->pclk); in inno_hdmi_bind()
903 struct inno_hdmi *hdmi = dev_get_drvdata(dev); in inno_hdmi_unbind() local
905 hdmi->connector.funcs->destroy(&hdmi->connector); in inno_hdmi_unbind()
906 hdmi->encoder.encoder.funcs->destroy(&hdmi->encoder.encoder); in inno_hdmi_unbind()
908 i2c_put_adapter(hdmi->ddc); in inno_hdmi_unbind()
909 clk_disable_unprepare(hdmi->pclk); in inno_hdmi_unbind()
928 { .compatible = "rockchip,rk3036-inno-hdmi",