Commit 5f9e228d authored by Andrzej Hajda's avatar Andrzej Hajda Committed by Inki Dae
Browse files

drm/exynos/hdmi: refactor infoframe code 



Use core helpers to generate infoframes and generate vendor frame if necessary.

Changelog:
- changed 'ret >= 0' checks to '!ret'

Signed-off-by: default avatarAndrzej Hajda <a.hajda@samsung.com>
Signed-off-by: default avatarInki Dae <inki.dae@samsung.com>
parent f03ee46b

drivers/gpu/drm/exynos/exynos_hdmi.c

+40 −101
Original line number Diff line number Diff line
@@ -47,19 +47,6 @@ 


#define HOTPLUG_DEBOUNCE_MS		1100



/* AVI header and aspect ratio */

#define HDMI_AVI_VERSION		0x02

#define HDMI_AVI_LENGTH			0x0d



/* AUI header info */

#define HDMI_AUI_VERSION		0x01

#define HDMI_AUI_LENGTH			0x0a



/* AVI active format aspect ratio */

#define AVI_SAME_AS_PIC_ASPECT_RATIO	0x08

#define AVI_4_3_CENTER_RATIO		0x09

#define AVI_16_9_CENTER_RATIO		0x0a



enum hdmi_type {

	HDMI_TYPE13,

	HDMI_TYPE14,
@@ -131,7 +118,6 @@ struct hdmi_context { 
	bool				dvi_mode;

	struct delayed_work		hotplug_work;

	struct drm_display_mode		current_mode;

	u8				cea_video_id;

	const struct hdmi_driver_data	*drv_data;



	void __iomem			*regs;
@@ -681,6 +667,13 @@ static inline void hdmi_reg_writev(struct hdmi_context *hdata, u32 reg_id, 
	}

}



static inline void hdmi_reg_write_buf(struct hdmi_context *hdata, u32 reg_id,

				      u8 *buf, int size)

{

	for (reg_id = hdmi_map_reg(hdata, reg_id); size; --size, reg_id += 4)

		writel(*buf++, hdata->regs + reg_id);

}



static inline void hdmi_reg_writemask(struct hdmi_context *hdata,

				 u32 reg_id, u32 value, u32 mask)

{
@@ -762,93 +755,50 @@ static int hdmi_clk_set_parents(struct hdmi_context *hdata, bool to_phy) 
	return ret;

}



static u8 hdmi_chksum(struct hdmi_context *hdata,

			u32 start, u8 len, u32 hdr_sum)

{

	int i;



	/* hdr_sum : header0 + header1 + header2

	* start : start address of packet byte1

	* len : packet bytes - 1 */

	for (i = 0; i < len; ++i)

		hdr_sum += 0xff & hdmi_reg_read(hdata, start + i * 4);



	/* return 2's complement of 8 bit hdr_sum */

	return (u8)(~(hdr_sum & 0xff) + 1);

}



static void hdmi_reg_infoframe(struct hdmi_context *hdata,

			union hdmi_infoframe *infoframe)

static void hdmi_reg_infoframes(struct hdmi_context *hdata)

{

	u32 hdr_sum;

	u8 chksum;

	u8 ar;

	union hdmi_infoframe frm;

	u8 buf[25];

	int ret;



	if (hdata->dvi_mode) {

		hdmi_reg_writeb(hdata, HDMI_VSI_CON,

				HDMI_VSI_CON_DO_NOT_TRANSMIT);

		hdmi_reg_writeb(hdata, HDMI_AVI_CON,

				HDMI_AVI_CON_DO_NOT_TRANSMIT);

		hdmi_reg_writeb(hdata, HDMI_VSI_CON,

				HDMI_VSI_CON_DO_NOT_TRANSMIT);

		hdmi_reg_writeb(hdata, HDMI_AUI_CON, HDMI_AUI_CON_NO_TRAN);

		return;

	}



	switch (infoframe->any.type) {

	case HDMI_INFOFRAME_TYPE_AVI:

	ret = drm_hdmi_avi_infoframe_from_display_mode(&frm.avi,

			&hdata->current_mode);

	if (!ret)

		ret = hdmi_avi_infoframe_pack(&frm.avi, buf, sizeof(buf));

	if (ret > 0) {

		hdmi_reg_writeb(hdata, HDMI_AVI_CON, HDMI_AVI_CON_EVERY_VSYNC);

		hdmi_reg_writeb(hdata, HDMI_AVI_HEADER0, infoframe->any.type);

		hdmi_reg_writeb(hdata, HDMI_AVI_HEADER1,

				infoframe->any.version);

		hdmi_reg_writeb(hdata, HDMI_AVI_HEADER2, infoframe->any.length);

		hdr_sum = infoframe->any.type + infoframe->any.version +

			  infoframe->any.length;



		/* Output format zero hardcoded ,RGB YBCR selection */

		hdmi_reg_writeb(hdata, HDMI_AVI_BYTE(1), 0 << 5 |

			AVI_ACTIVE_FORMAT_VALID |

			AVI_UNDERSCANNED_DISPLAY_VALID);



		/*

		 * Set the aspect ratio as per the mode, mentioned in

		 * Table 9 AVI InfoFrame Data Byte 2 of CEA-861-D Standard

		 */

		ar = hdata->current_mode.picture_aspect_ratio;

		switch (ar) {

		case HDMI_PICTURE_ASPECT_4_3:

			ar |= AVI_4_3_CENTER_RATIO;

			break;

		case HDMI_PICTURE_ASPECT_16_9:

			ar |= AVI_16_9_CENTER_RATIO;

			break;

		case HDMI_PICTURE_ASPECT_NONE:

		default:

			ar |= AVI_SAME_AS_PIC_ASPECT_RATIO;

			break;

		hdmi_reg_write_buf(hdata, HDMI_AVI_HEADER0, buf, ret);

	} else {

		DRM_INFO("%s: invalid AVI infoframe (%d)\n", __func__, ret);

	}

		hdmi_reg_writeb(hdata, HDMI_AVI_BYTE(2), ar);



		hdmi_reg_writeb(hdata, HDMI_AVI_BYTE(4), hdata->cea_video_id);

	ret = drm_hdmi_vendor_infoframe_from_display_mode(&frm.vendor.hdmi,

			&hdata->current_mode);

	if (!ret)

		ret = hdmi_vendor_infoframe_pack(&frm.vendor.hdmi, buf,

				sizeof(buf));

	if (ret > 0) {

		hdmi_reg_writeb(hdata, HDMI_VSI_CON, HDMI_VSI_CON_EVERY_VSYNC);

		hdmi_reg_write_buf(hdata, HDMI_VSI_HEADER0, buf, ret);

	}



		chksum = hdmi_chksum(hdata, HDMI_AVI_BYTE(1),

					infoframe->any.length, hdr_sum);

		DRM_DEBUG_KMS("AVI checksum = 0x%x\n", chksum);

		hdmi_reg_writeb(hdata, HDMI_AVI_CHECK_SUM, chksum);

		break;

	case HDMI_INFOFRAME_TYPE_AUDIO:

		hdmi_reg_writeb(hdata, HDMI_AUI_CON, 0x02);

		hdmi_reg_writeb(hdata, HDMI_AUI_HEADER0, infoframe->any.type);

		hdmi_reg_writeb(hdata, HDMI_AUI_HEADER1,

				infoframe->any.version);

		hdmi_reg_writeb(hdata, HDMI_AUI_HEADER2, infoframe->any.length);

		hdr_sum = infoframe->any.type + infoframe->any.version +

			  infoframe->any.length;

		chksum = hdmi_chksum(hdata, HDMI_AUI_BYTE(1),

					infoframe->any.length, hdr_sum);

		DRM_DEBUG_KMS("AUI checksum = 0x%x\n", chksum);

		hdmi_reg_writeb(hdata, HDMI_AUI_CHECK_SUM, chksum);

		break;

	default:

		break;

	ret = hdmi_audio_infoframe_init(&frm.audio);

	if (!ret) {

		frm.audio.channels = 2;

		ret = hdmi_audio_infoframe_pack(&frm.audio, buf, sizeof(buf));

	}

	if (ret > 0) {

		hdmi_reg_writeb(hdata, HDMI_AUI_CON, HDMI_AUI_CON_EVERY_VSYNC);

		hdmi_reg_write_buf(hdata, HDMI_AUI_HEADER0, buf, ret);

	}

}
@@ -1127,8 +1077,6 @@ static void hdmi_start(struct hdmi_context *hdata, bool start) 


static void hdmi_conf_init(struct hdmi_context *hdata)

{

	union hdmi_infoframe infoframe;



	/* disable HPD interrupts from HDMI IP block, use GPIO instead */

	hdmi_reg_writemask(hdata, HDMI_INTC_CON, 0, HDMI_INTC_EN_GLOBAL |

		HDMI_INTC_EN_HPD_PLUG | HDMI_INTC_EN_HPD_UNPLUG);
@@ -1164,15 +1112,7 @@ static void hdmi_conf_init(struct hdmi_context *hdata) 
		hdmi_reg_writeb(hdata, HDMI_V13_AUI_CON, 0x02);

		hdmi_reg_writeb(hdata, HDMI_V13_ACR_CON, 0x04);

	} else {

		infoframe.any.type = HDMI_INFOFRAME_TYPE_AVI;

		infoframe.any.version = HDMI_AVI_VERSION;

		infoframe.any.length = HDMI_AVI_LENGTH;

		hdmi_reg_infoframe(hdata, &infoframe);



		infoframe.any.type = HDMI_INFOFRAME_TYPE_AUDIO;

		infoframe.any.version = HDMI_AUI_VERSION;

		infoframe.any.length = HDMI_AUI_LENGTH;

		hdmi_reg_infoframe(hdata, &infoframe);

		hdmi_reg_infoframes(hdata);



		/* enable AVI packet every vsync, fixes purple line problem */

		hdmi_reg_writemask(hdata, HDMI_CON_1, 2, 3 << 5);
@@ -1458,7 +1398,6 @@ static void hdmi_mode_set(struct drm_encoder *encoder, 
		"INTERLACED" : "PROGRESSIVE");



	drm_mode_copy(&hdata->current_mode, m);

	hdata->cea_video_id = drm_match_cea_mode(mode);

}



static void hdmi_set_refclk(struct hdmi_context *hdata, bool on)

drivers/gpu/drm/exynos/regs-hdmi.h

+2 −0
Original line number Diff line number Diff line
@@ -361,9 +361,11 @@ 


/* AUI bit definition */

#define HDMI_AUI_CON_NO_TRAN		(0 << 0)

#define HDMI_AUI_CON_EVERY_VSYNC	(1 << 1)



/* VSI bit definition */

#define HDMI_VSI_CON_DO_NOT_TRANSMIT	(0 << 0)

#define HDMI_VSI_CON_EVERY_VSYNC	(1 << 1)



/* HDCP related registers */

#define HDMI_HDCP_SHA1(n)		HDMI_CORE_BASE(0x7000 + 4 * (n))