[linux-2.6-block.git] / drivers / video / hdmi.c

/*
 * Copyright (C) 2012 Avionic Design GmbH
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sub license,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the
 * next paragraph) shall be included in all copies or substantial portions
 * of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 */

#include <linux/bitops.h>
#include <linux/bug.h>
#include <linux/errno.h>
#include <linux/export.h>
#include <linux/hdmi.h>
#include <linux/string.h>

static void hdmi_infoframe_checksum(void *buffer, size_t size)
{
	u8 *ptr = buffer;
	u8 csum = 0;
	size_t i;

	/* compute checksum */
	for (i = 0; i < size; i++)
		csum += ptr[i];

	ptr[3] = 256 - csum;
}

/**
 * hdmi_avi_infoframe_init() - initialize an HDMI AVI infoframe
 * @frame: HDMI AVI infoframe
 *
 * Returns 0 on success or a negative error code on failure.
 */
int hdmi_avi_infoframe_init(struct hdmi_avi_infoframe *frame)
{
	memset(frame, 0, sizeof(*frame));

	frame->type = HDMI_INFOFRAME_TYPE_AVI;
	frame->version = 2;
	frame->length = HDMI_AVI_INFOFRAME_SIZE;

	return 0;
}
EXPORT_SYMBOL(hdmi_avi_infoframe_init);

/**
 * hdmi_avi_infoframe_pack() - write HDMI AVI infoframe to binary buffer
 * @frame: HDMI AVI infoframe
 * @buffer: destination buffer
 * @size: size of buffer
 *
 * Packs the information contained in the @frame structure into a binary
 * representation that can be written into the corresponding controller
 * registers. Also computes the checksum as required by section 5.3.5 of
 * the HDMI 1.4 specification.
 *
 * Returns the number of bytes packed into the binary buffer or a negative
 * error code on failure.
 */
ssize_t hdmi_avi_infoframe_pack(struct hdmi_avi_infoframe *frame, void *buffer,
				size_t size)
{
	u8 *ptr = buffer;
	size_t length;

	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;

	if (size < length)
		return -ENOSPC;

	memset(buffer, 0, size);

	ptr[0] = frame->type;
	ptr[1] = frame->version;
	ptr[2] = frame->length;
	ptr[3] = 0; /* checksum */

	/* start infoframe payload */
	ptr += HDMI_INFOFRAME_HEADER_SIZE;

	ptr[0] = ((frame->colorspace & 0x3) << 5) | (frame->scan_mode & 0x3);

	/*
	 * Data byte 1, bit 4 has to be set if we provide the active format
	 * aspect ratio
	 */
	if (frame->active_aspect & 0xf)
		ptr[0] |= BIT(4);

	/* Bit 3 and 2 indicate if we transmit horizontal/vertical bar data */
	if (frame->top_bar || frame->bottom_bar)
		ptr[0] |= BIT(3);

	if (frame->left_bar || frame->right_bar)
		ptr[0] |= BIT(2);

	ptr[1] = ((frame->colorimetry & 0x3) << 6) |
		 ((frame->picture_aspect & 0x3) << 4) |
		 (frame->active_aspect & 0xf);

	ptr[2] = ((frame->extended_colorimetry & 0x7) << 4) |
		 ((frame->quantization_range & 0x3) << 2) |
		 (frame->nups & 0x3);

	if (frame->itc)
		ptr[2] |= BIT(7);

	ptr[3] = frame->video_code & 0x7f;

	ptr[4] = ((frame->ycc_quantization_range & 0x3) << 6) |
		 ((frame->content_type & 0x3) << 4) |
		 (frame->pixel_repeat & 0xf);

	ptr[5] = frame->top_bar & 0xff;
	ptr[6] = (frame->top_bar >> 8) & 0xff;
	ptr[7] = frame->bottom_bar & 0xff;
	ptr[8] = (frame->bottom_bar >> 8) & 0xff;
	ptr[9] = frame->left_bar & 0xff;
	ptr[10] = (frame->left_bar >> 8) & 0xff;
	ptr[11] = frame->right_bar & 0xff;
	ptr[12] = (frame->right_bar >> 8) & 0xff;

	hdmi_infoframe_checksum(buffer, length);

	return length;
}
EXPORT_SYMBOL(hdmi_avi_infoframe_pack);

/**
 * hdmi_spd_infoframe_init() - initialize an HDMI SPD infoframe
 * @frame: HDMI SPD infoframe
 * @vendor: vendor string
 * @product: product string
 *
 * Returns 0 on success or a negative error code on failure.
 */
int hdmi_spd_infoframe_init(struct hdmi_spd_infoframe *frame,
			    const char *vendor, const char *product)
{
	memset(frame, 0, sizeof(*frame));

	frame->type = HDMI_INFOFRAME_TYPE_SPD;
	frame->version = 1;
	frame->length = HDMI_SPD_INFOFRAME_SIZE;

	strncpy(frame->vendor, vendor, sizeof(frame->vendor));
	strncpy(frame->product, product, sizeof(frame->product));

	return 0;
}
EXPORT_SYMBOL(hdmi_spd_infoframe_init);

/**
 * hdmi_spd_infoframe_pack() - write HDMI SPD infoframe to binary buffer
 * @frame: HDMI SPD infoframe
 * @buffer: destination buffer
 * @size: size of buffer
 *
 * Packs the information contained in the @frame structure into a binary
 * representation that can be written into the corresponding controller
 * registers. Also computes the checksum as required by section 5.3.5 of
 * the HDMI 1.4 specification.
 *
 * Returns the number of bytes packed into the binary buffer or a negative
 * error code on failure.
 */
ssize_t hdmi_spd_infoframe_pack(struct hdmi_spd_infoframe *frame, void *buffer,
				size_t size)
{
	u8 *ptr = buffer;
	size_t length;

	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;

	if (size < length)
		return -ENOSPC;

	memset(buffer, 0, size);

	ptr[0] = frame->type;
	ptr[1] = frame->version;
	ptr[2] = frame->length;
	ptr[3] = 0; /* checksum */

	/* start infoframe payload */
	ptr += HDMI_INFOFRAME_HEADER_SIZE;

	memcpy(ptr, frame->vendor, sizeof(frame->vendor));
	memcpy(ptr + 8, frame->product, sizeof(frame->product));

	ptr[24] = frame->sdi;

	hdmi_infoframe_checksum(buffer, length);

	return length;
}
EXPORT_SYMBOL(hdmi_spd_infoframe_pack);

/**
 * hdmi_audio_infoframe_init() - initialize an HDMI audio infoframe
 * @frame: HDMI audio infoframe
 *
 * Returns 0 on success or a negative error code on failure.
 */
int hdmi_audio_infoframe_init(struct hdmi_audio_infoframe *frame)
{
	memset(frame, 0, sizeof(*frame));

	frame->type = HDMI_INFOFRAME_TYPE_AUDIO;
	frame->version = 1;
	frame->length = HDMI_AUDIO_INFOFRAME_SIZE;

	return 0;
}
EXPORT_SYMBOL(hdmi_audio_infoframe_init);

/**
 * hdmi_audio_infoframe_pack() - write HDMI audio infoframe to binary buffer
 * @frame: HDMI audio infoframe
 * @buffer: destination buffer
 * @size: size of buffer
 *
 * Packs the information contained in the @frame structure into a binary
 * representation that can be written into the corresponding controller
 * registers. Also computes the checksum as required by section 5.3.5 of
 * the HDMI 1.4 specification.
 *
 * Returns the number of bytes packed into the binary buffer or a negative
 * error code on failure.
 */
ssize_t hdmi_audio_infoframe_pack(struct hdmi_audio_infoframe *frame,
				  void *buffer, size_t size)
{
	unsigned char channels;
	u8 *ptr = buffer;
	size_t length;

	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;

	if (size < length)
		return -ENOSPC;

	memset(buffer, 0, size);

	if (frame->channels >= 2)
		channels = frame->channels - 1;
	else
		channels = 0;

	ptr[0] = frame->type;
	ptr[1] = frame->version;
	ptr[2] = frame->length;
	ptr[3] = 0; /* checksum */

	/* start infoframe payload */
	ptr += HDMI_INFOFRAME_HEADER_SIZE;

	ptr[0] = ((frame->coding_type & 0xf) << 4) | (channels & 0x7);
	ptr[1] = ((frame->sample_frequency & 0x7) << 2) |
		 (frame->sample_size & 0x3);
	ptr[2] = frame->coding_type_ext & 0x1f;
	ptr[3] = frame->channel_allocation;
	ptr[4] = (frame->level_shift_value & 0xf) << 3;

	if (frame->downmix_inhibit)
		ptr[4] |= BIT(7);

	hdmi_infoframe_checksum(buffer, length);

	return length;
}
EXPORT_SYMBOL(hdmi_audio_infoframe_pack);

/**
 * hdmi_hdmi_infoframe_init() - initialize an HDMI vendor infoframe
 * @frame: HDMI vendor infoframe
 *
 * Returns 0 on success or a negative error code on failure.
 */
int hdmi_hdmi_infoframe_init(struct hdmi_hdmi_infoframe *frame)
{
	memset(frame, 0, sizeof(*frame));

	frame->type = HDMI_INFOFRAME_TYPE_VENDOR;
	frame->version = 1;

	/*
	 * 0 is a valid value for s3d_struct, so we use a special "not set"
	 * value
	 */
	frame->s3d_struct = HDMI_3D_STRUCTURE_INVALID;

	return 0;
}
EXPORT_SYMBOL(hdmi_hdmi_infoframe_init);

/**
 * hdmi_hdmi_infoframe_pack() - write a HDMI vendor infoframe to binary buffer
 * @frame: HDMI infoframe
 * @buffer: destination buffer
 * @size: size of buffer
 *
 * Packs the information contained in the @frame structure into a binary
 * representation that can be written into the corresponding controller
 * registers. Also computes the checksum as required by section 5.3.5 of
 * the HDMI 1.4 specification.
 *
 * Returns the number of bytes packed into the binary buffer or a negative
 * error code on failure.
 */
ssize_t hdmi_hdmi_infoframe_pack(struct hdmi_hdmi_infoframe *frame,
				 void *buffer, size_t size)
{
	u8 *ptr = buffer;
	size_t length;

	/* empty info frame */
	if (frame->vic == 0 && frame->s3d_struct == HDMI_3D_STRUCTURE_INVALID)
		return -EINVAL;

	/* only one of those can be supplied */
	if (frame->vic != 0 && frame->s3d_struct != HDMI_3D_STRUCTURE_INVALID)
		return -EINVAL;

	/* for side by side (half) we also need to provide 3D_Ext_Data */
	if (frame->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
		frame->length = 6;
	else
		frame->length = 5;

	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;

	if (size < length)
		return -ENOSPC;

	memset(buffer, 0, size);

	ptr[0] = frame->type;
	ptr[1] = frame->version;
	ptr[2] = frame->length;
	ptr[3] = 0; /* checksum */

	/* HDMI OUI */
	ptr[4] = 0x03;
	ptr[5] = 0x0c;
	ptr[6] = 0x00;

	if (frame->vic) {
		ptr[7] = 0x1 << 5;	/* video format */
		ptr[8] = frame->vic;
	} else {
		ptr[7] = 0x2 << 5;	/* video format */
		ptr[8] = (frame->s3d_struct & 0xf) << 4;
		if (frame->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
			ptr[9] = (frame->s3d_ext_data & 0xf) << 4;
	}

	hdmi_infoframe_checksum(buffer, length);

	return length;
}
EXPORT_SYMBOL(hdmi_hdmi_infoframe_pack);

/**
 * hdmi_vendor_infoframe_pack() - write a HDMI vendor infoframe to binary
 *                                buffer
 * @frame: HDMI vendor infoframe
 * @buffer: destination buffer
 * @size: size of buffer
 *
 * Packs the information contained in the @frame structure into a binary
 * representation that can be written into the corresponding controller
 * registers. Also computes the checksum as required by section 5.3.5 of
 * the HDMI 1.4 specification.
 *
 * Returns the number of bytes packed into the binary buffer or a negative
 * error code on failure.
 */
ssize_t hdmi_vendor_infoframe_pack(struct hdmi_vendor_infoframe *frame,
				   void *buffer, size_t size)
{
	u8 *ptr = buffer;
	size_t length;

	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;

	if (size < length)
		return -ENOSPC;

	memset(buffer, 0, size);

	ptr[0] = frame->type;
	ptr[1] = frame->version;
	ptr[2] = frame->length;
	ptr[3] = 0; /* checksum */

	memcpy(&ptr[HDMI_INFOFRAME_HEADER_SIZE], frame->data, frame->length);

	hdmi_infoframe_checksum(buffer, length);

	return length;
}
EXPORT_SYMBOL(hdmi_vendor_infoframe_pack);

/**
 * hdmi_infoframe_pack() - write a HDMI infoframe to binary buffer
 * @frame: HDMI infoframe
 * @buffer: destination buffer
 * @size: size of buffer
 *
 * Packs the information contained in the @frame structure into a binary
 * representation that can be written into the corresponding controller
 * registers. Also computes the checksum as required by section 5.3.5 of
 * the HDMI 1.4 specification.
 *
 * Returns the number of bytes packed into the binary buffer or a negative
 * error code on failure.
 */
ssize_t
hdmi_infoframe_pack(union hdmi_infoframe *frame, void *buffer, size_t size)
{
	ssize_t length;

	switch (frame->any.type) {
	case HDMI_INFOFRAME_TYPE_AVI:
		length = hdmi_avi_infoframe_pack(&frame->avi, buffer, size);
		break;
	case HDMI_INFOFRAME_TYPE_SPD:
		length = hdmi_spd_infoframe_pack(&frame->spd, buffer, size);
		break;
	case HDMI_INFOFRAME_TYPE_AUDIO:
		length = hdmi_audio_infoframe_pack(&frame->audio, buffer, size);
		break;
	case HDMI_INFOFRAME_TYPE_VENDOR:
		length = hdmi_vendor_infoframe_pack(&frame->vendor,
						    buffer, size);
		break;
	default:
		WARN(1, "Bad infoframe type %d\n", frame->any.type);
		length = -EINVAL;
	}

	return length;
}
EXPORT_SYMBOL(hdmi_infoframe_pack);
Commit	Line	Data
f142d3bd TR	1	/*
	2	* Copyright (C) 2012 Avionic Design GmbH
	3	*
96d672e0 TR	4	* Permission is hereby granted, free of charge, to any person obtaining a
	5	* copy of this software and associated documentation files (the "Software"),
	6	* to deal in the Software without restriction, including without limitation
	7	* the rights to use, copy, modify, merge, publish, distribute, sub license,
	8	* and/or sell copies of the Software, and to permit persons to whom the
	9	* Software is furnished to do so, subject to the following conditions:
	10	*
	11	* The above copyright notice and this permission notice (including the
	12	* next paragraph) shall be included in all copies or substantial portions
	13	* of the Software.
	14	*
	15	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	16	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	17	* FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
	18	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	19	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
	20	* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
	21	* DEALINGS IN THE SOFTWARE.
f142d3bd TR	22	*/
	23
	24	#include <linux/bitops.h>
72b09896	25	#include <linux/bug.h>
f142d3bd TR	26	#include <linux/errno.h>
	27	#include <linux/export.h>
	28	#include <linux/hdmi.h>
	29	#include <linux/string.h>
	30
	31	static void hdmi_infoframe_checksum(void *buffer, size_t size)
	32	{
	33	u8 *ptr = buffer;
	34	u8 csum = 0;
	35	size_t i;
	36
	37	/* compute checksum */
	38	for (i = 0; i < size; i++)
	39	csum += ptr[i];
	40
	41	ptr[3] = 256 - csum;
	42	}
	43
	44	/**
	45	* hdmi_avi_infoframe_init() - initialize an HDMI AVI infoframe
	46	* @frame: HDMI AVI infoframe
	47	*
	48	* Returns 0 on success or a negative error code on failure.
	49	*/
	50	int hdmi_avi_infoframe_init(struct hdmi_avi_infoframe *frame)
	51	{
	52	memset(frame, 0, sizeof(*frame));
	53
	54	frame->type = HDMI_INFOFRAME_TYPE_AVI;
	55	frame->version = 2;
3c6b054d	56	frame->length = HDMI_AVI_INFOFRAME_SIZE;
f142d3bd TR	57
	58	return 0;
	59	}
	60	EXPORT_SYMBOL(hdmi_avi_infoframe_init);
	61
	62	/**
	63	* hdmi_avi_infoframe_pack() - write HDMI AVI infoframe to binary buffer
	64	* @frame: HDMI AVI infoframe
	65	* @buffer: destination buffer
	66	* @size: size of buffer
	67	*
	68	* Packs the information contained in the @frame structure into a binary
	69	* representation that can be written into the corresponding controller
	70	* registers. Also computes the checksum as required by section 5.3.5 of
	71	* the HDMI 1.4 specification.
	72	*
	73	* Returns the number of bytes packed into the binary buffer or a negative
	74	* error code on failure.
	75	*/
	76	ssize_t hdmi_avi_infoframe_pack(struct hdmi_avi_infoframe frame, void buffer,
	77	size_t size)
	78	{
	79	u8 *ptr = buffer;
	80	size_t length;
	81
	82	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
	83
	84	if (size < length)
	85	return -ENOSPC;
	86
3b390f62	87	memset(buffer, 0, size);
f142d3bd TR	88
	89	ptr[0] = frame->type;
	90	ptr[1] = frame->version;
	91	ptr[2] = frame->length;
	92	ptr[3] = 0; /* checksum */
	93
	94	/* start infoframe payload */
	95	ptr += HDMI_INFOFRAME_HEADER_SIZE;
	96
	97	ptr[0] = ((frame->colorspace & 0x3) << 5) \| (frame->scan_mode & 0x3);
	98
a5ad3dcf LD	99	/*
	100	* Data byte 1, bit 4 has to be set if we provide the active format
	101	* aspect ratio
	102	*/
	103	if (frame->active_aspect & 0xf)
f142d3bd TR	104	ptr[0] \|= BIT(4);
f142d3bd TR	105
974e0701 LD	106	/* Bit 3 and 2 indicate if we transmit horizontal/vertical bar data */
974e0701 LD	107	if (frame->top_bar \|\| frame->bottom_bar)
f142d3bd TR	108	ptr[0] \|= BIT(3);
f142d3bd TR	109
974e0701	110	if (frame->left_bar \|\| frame->right_bar)
f142d3bd TR	111	ptr[0] \|= BIT(2);
	112
	113	ptr[1] = ((frame->colorimetry & 0x3) << 6) \|
	114	((frame->picture_aspect & 0x3) << 4) \|
	115	(frame->active_aspect & 0xf);
	116
	117	ptr[2] = ((frame->extended_colorimetry & 0x7) << 4) \|
	118	((frame->quantization_range & 0x3) << 2) \|
	119	(frame->nups & 0x3);
	120
	121	if (frame->itc)
	122	ptr[2] \|= BIT(7);
	123
	124	ptr[3] = frame->video_code & 0x7f;
	125
	126	ptr[4] = ((frame->ycc_quantization_range & 0x3) << 6) \|
	127	((frame->content_type & 0x3) << 4) \|
	128	(frame->pixel_repeat & 0xf);
	129
	130	ptr[5] = frame->top_bar & 0xff;
	131	ptr[6] = (frame->top_bar >> 8) & 0xff;
	132	ptr[7] = frame->bottom_bar & 0xff;
	133	ptr[8] = (frame->bottom_bar >> 8) & 0xff;
	134	ptr[9] = frame->left_bar & 0xff;
	135	ptr[10] = (frame->left_bar >> 8) & 0xff;
	136	ptr[11] = frame->right_bar & 0xff;
	137	ptr[12] = (frame->right_bar >> 8) & 0xff;
	138
	139	hdmi_infoframe_checksum(buffer, length);
	140
	141	return length;
	142	}
	143	EXPORT_SYMBOL(hdmi_avi_infoframe_pack);
	144
	145	/**
	146	* hdmi_spd_infoframe_init() - initialize an HDMI SPD infoframe
	147	* @frame: HDMI SPD infoframe
	148	* @vendor: vendor string
	149	* @product: product string
	150	*
	151	* Returns 0 on success or a negative error code on failure.
	152	*/
	153	int hdmi_spd_infoframe_init(struct hdmi_spd_infoframe *frame,
	154	const char vendor, const char product)
	155	{
	156	memset(frame, 0, sizeof(*frame));
	157
	158	frame->type = HDMI_INFOFRAME_TYPE_SPD;
	159	frame->version = 1;
3c6b054d	160	frame->length = HDMI_SPD_INFOFRAME_SIZE;
f142d3bd TR	161
	162	strncpy(frame->vendor, vendor, sizeof(frame->vendor));
	163	strncpy(frame->product, product, sizeof(frame->product));
	164
	165	return 0;
	166	}
	167	EXPORT_SYMBOL(hdmi_spd_infoframe_init);
	168
	169	/**
	170	* hdmi_spd_infoframe_pack() - write HDMI SPD infoframe to binary buffer
	171	* @frame: HDMI SPD infoframe
	172	* @buffer: destination buffer
	173	* @size: size of buffer
	174	*
	175	* Packs the information contained in the @frame structure into a binary
	176	* representation that can be written into the corresponding controller
	177	* registers. Also computes the checksum as required by section 5.3.5 of
	178	* the HDMI 1.4 specification.
	179	*
	180	* Returns the number of bytes packed into the binary buffer or a negative
	181	* error code on failure.
	182	*/
	183	ssize_t hdmi_spd_infoframe_pack(struct hdmi_spd_infoframe frame, void buffer,
	184	size_t size)
	185	{
	186	u8 *ptr = buffer;
	187	size_t length;
	188
	189	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
	190
	191	if (size < length)
	192	return -ENOSPC;
	193
3b390f62	194	memset(buffer, 0, size);
f142d3bd TR	195
	196	ptr[0] = frame->type;
	197	ptr[1] = frame->version;
	198	ptr[2] = frame->length;
	199	ptr[3] = 0; /* checksum */
	200
	201	/* start infoframe payload */
	202	ptr += HDMI_INFOFRAME_HEADER_SIZE;
	203
	204	memcpy(ptr, frame->vendor, sizeof(frame->vendor));
	205	memcpy(ptr + 8, frame->product, sizeof(frame->product));
	206
	207	ptr[24] = frame->sdi;
	208
	209	hdmi_infoframe_checksum(buffer, length);
	210
	211	return length;
	212	}
	213	EXPORT_SYMBOL(hdmi_spd_infoframe_pack);
	214
	215	/**
	216	* hdmi_audio_infoframe_init() - initialize an HDMI audio infoframe
	217	* @frame: HDMI audio infoframe
	218	*
	219	* Returns 0 on success or a negative error code on failure.
	220	*/
	221	int hdmi_audio_infoframe_init(struct hdmi_audio_infoframe *frame)
	222	{
	223	memset(frame, 0, sizeof(*frame));
	224
	225	frame->type = HDMI_INFOFRAME_TYPE_AUDIO;
	226	frame->version = 1;
3c6b054d	227	frame->length = HDMI_AUDIO_INFOFRAME_SIZE;
f142d3bd TR	228
	229	return 0;
	230	}
	231	EXPORT_SYMBOL(hdmi_audio_infoframe_init);
	232
	233	/**
	234	* hdmi_audio_infoframe_pack() - write HDMI audio infoframe to binary buffer
	235	* @frame: HDMI audio infoframe
	236	* @buffer: destination buffer
	237	* @size: size of buffer
	238	*
	239	* Packs the information contained in the @frame structure into a binary
	240	* representation that can be written into the corresponding controller
	241	* registers. Also computes the checksum as required by section 5.3.5 of
	242	* the HDMI 1.4 specification.
	243	*
	244	* Returns the number of bytes packed into the binary buffer or a negative
	245	* error code on failure.
	246	*/
	247	ssize_t hdmi_audio_infoframe_pack(struct hdmi_audio_infoframe *frame,
	248	void *buffer, size_t size)
	249	{
	250	unsigned char channels;
	251	u8 *ptr = buffer;
	252	size_t length;
	253
	254	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
	255
	256	if (size < length)
	257	return -ENOSPC;
	258
3b390f62	259	memset(buffer, 0, size);
f142d3bd TR	260
	261	if (frame->channels >= 2)
	262	channels = frame->channels - 1;
	263	else
	264	channels = 0;
	265
	266	ptr[0] = frame->type;
	267	ptr[1] = frame->version;
	268	ptr[2] = frame->length;
	269	ptr[3] = 0; /* checksum */
	270
	271	/* start infoframe payload */
	272	ptr += HDMI_INFOFRAME_HEADER_SIZE;
	273
	274	ptr[0] = ((frame->coding_type & 0xf) << 4) \| (channels & 0x7);
	275	ptr[1] = ((frame->sample_frequency & 0x7) << 2) \|
	276	(frame->sample_size & 0x3);
	277	ptr[2] = frame->coding_type_ext & 0x1f;
	278	ptr[3] = frame->channel_allocation;
	279	ptr[4] = (frame->level_shift_value & 0xf) << 3;
	280
	281	if (frame->downmix_inhibit)
	282	ptr[4] \|= BIT(7);
	283
	284	hdmi_infoframe_checksum(buffer, length);
	285
	286	return length;
	287	}
	288	EXPORT_SYMBOL(hdmi_audio_infoframe_pack);
	289
7d27becb LD	290	/**
	291	* hdmi_hdmi_infoframe_init() - initialize an HDMI vendor infoframe
	292	* @frame: HDMI vendor infoframe
	293	*
	294	* Returns 0 on success or a negative error code on failure.
	295	*/
	296	int hdmi_hdmi_infoframe_init(struct hdmi_hdmi_infoframe *frame)
	297	{
	298	memset(frame, 0, sizeof(*frame));
	299
	300	frame->type = HDMI_INFOFRAME_TYPE_VENDOR;
	301	frame->version = 1;
	302
	303	/*
	304	* 0 is a valid value for s3d_struct, so we use a special "not set"
	305	* value
	306	*/
	307	frame->s3d_struct = HDMI_3D_STRUCTURE_INVALID;
	308
	309	return 0;
	310	}
	311	EXPORT_SYMBOL(hdmi_hdmi_infoframe_init);
	312
	313	/**
	314	* hdmi_hdmi_infoframe_pack() - write a HDMI vendor infoframe to binary buffer
	315	* @frame: HDMI infoframe
	316	* @buffer: destination buffer
	317	* @size: size of buffer
	318	*
	319	* Packs the information contained in the @frame structure into a binary
	320	* representation that can be written into the corresponding controller
	321	* registers. Also computes the checksum as required by section 5.3.5 of
	322	* the HDMI 1.4 specification.
	323	*
	324	* Returns the number of bytes packed into the binary buffer or a negative
	325	* error code on failure.
	326	*/
	327	ssize_t hdmi_hdmi_infoframe_pack(struct hdmi_hdmi_infoframe *frame,
	328	void *buffer, size_t size)
	329	{
	330	u8 *ptr = buffer;
	331	size_t length;
	332
	333	/* empty info frame */
	334	if (frame->vic == 0 && frame->s3d_struct == HDMI_3D_STRUCTURE_INVALID)
	335	return -EINVAL;
	336
	337	/* only one of those can be supplied */
	338	if (frame->vic != 0 && frame->s3d_struct != HDMI_3D_STRUCTURE_INVALID)
	339	return -EINVAL;
	340
	341	/* for side by side (half) we also need to provide 3D_Ext_Data */
	342	if (frame->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
	343	frame->length = 6;
	344	else
	345	frame->length = 5;
	346
	347	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
	348
	349	if (size < length)
	350	return -ENOSPC;
	351
	352	memset(buffer, 0, size);
	353
354	ptr[0] = frame->type;
355	ptr[1] = frame->version;
356	ptr[2] = frame->length;
357	ptr[3] = 0; /* checksum */
358
359	/* HDMI OUI */
360	ptr[4] = 0x03;
361	ptr[5] = 0x0c;
362	ptr[6] = 0x00;
363
364	if (frame->vic) {
365	ptr[7] = 0x1 << 5; /* video format */
366	ptr[8] = frame->vic;
367	} else {
368	ptr[7] = 0x2 << 5; /* video format */
369	ptr[8] = (frame->s3d_struct & 0xf) << 4;
370	if (frame->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
371	ptr[9] = (frame->s3d_ext_data & 0xf) << 4;
372	}
373
374	hdmi_infoframe_checksum(buffer, length);
375
376	return length;
377	}
378	EXPORT_SYMBOL(hdmi_hdmi_infoframe_pack);
379
f142d3bd TR	380	/**
	381	* hdmi_vendor_infoframe_pack() - write a HDMI vendor infoframe to binary
	382	* buffer
	383	* @frame: HDMI vendor infoframe
	384	* @buffer: destination buffer
	385	* @size: size of buffer
	386	*
	387	* Packs the information contained in the @frame structure into a binary
	388	* representation that can be written into the corresponding controller
	389	* registers. Also computes the checksum as required by section 5.3.5 of
	390	* the HDMI 1.4 specification.
	391	*
	392	* Returns the number of bytes packed into the binary buffer or a negative
	393	* error code on failure.
	394	*/
	395	ssize_t hdmi_vendor_infoframe_pack(struct hdmi_vendor_infoframe *frame,
	396	void *buffer, size_t size)
	397	{
	398	u8 *ptr = buffer;
	399	size_t length;
	400
	401	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
	402
	403	if (size < length)
	404	return -ENOSPC;
	405
3b390f62	406	memset(buffer, 0, size);
f142d3bd TR	407
	408	ptr[0] = frame->type;
	409	ptr[1] = frame->version;
	410	ptr[2] = frame->length;
	411	ptr[3] = 0; /* checksum */
	412
	413	memcpy(&ptr[HDMI_INFOFRAME_HEADER_SIZE], frame->data, frame->length);
	414
	415	hdmi_infoframe_checksum(buffer, length);
	416
	417	return length;
	418	}
	419	EXPORT_SYMBOL(hdmi_vendor_infoframe_pack);
72b09896 DL	420
	421	/**
	422	* hdmi_infoframe_pack() - write a HDMI infoframe to binary buffer
	423	* @frame: HDMI infoframe
	424	* @buffer: destination buffer
	425	* @size: size of buffer
	426	*
	427	* Packs the information contained in the @frame structure into a binary
	428	* representation that can be written into the corresponding controller
	429	* registers. Also computes the checksum as required by section 5.3.5 of
	430	* the HDMI 1.4 specification.
	431	*
	432	* Returns the number of bytes packed into the binary buffer or a negative
	433	* error code on failure.
	434	*/
	435	ssize_t
	436	hdmi_infoframe_pack(union hdmi_infoframe frame, void buffer, size_t size)
	437	{
	438	ssize_t length;
	439
	440	switch (frame->any.type) {
	441	case HDMI_INFOFRAME_TYPE_AVI:
	442	length = hdmi_avi_infoframe_pack(&frame->avi, buffer, size);
	443	break;
	444	case HDMI_INFOFRAME_TYPE_SPD:
	445	length = hdmi_spd_infoframe_pack(&frame->spd, buffer, size);
	446	break;
	447	case HDMI_INFOFRAME_TYPE_AUDIO:
	448	length = hdmi_audio_infoframe_pack(&frame->audio, buffer, size);
	449	break;
	450	case HDMI_INFOFRAME_TYPE_VENDOR:
	451	length = hdmi_vendor_infoframe_pack(&frame->vendor,
	452	buffer, size);
	453	break;
	454	default:
	455	WARN(1, "Bad infoframe type %d\n", frame->any.type);
	456	length = -EINVAL;
	457	}
	458
	459	return length;
	460	}
	461	EXPORT_SYMBOL(hdmi_infoframe_pack);