[deliverable/linux.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_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
	290	/**
	291	* hdmi_vendor_infoframe_pack() - write a HDMI vendor infoframe to binary
	292	* buffer
	293	* @frame: HDMI vendor infoframe
	294	* @buffer: destination buffer
	295	* @size: size of buffer
	296	*
	297	* Packs the information contained in the @frame structure into a binary
	298	* representation that can be written into the corresponding controller
	299	* registers. Also computes the checksum as required by section 5.3.5 of
	300	* the HDMI 1.4 specification.
	301	*
	302	* Returns the number of bytes packed into the binary buffer or a negative
	303	* error code on failure.
	304	*/
	305	ssize_t hdmi_vendor_infoframe_pack(struct hdmi_vendor_infoframe *frame,
	306	void *buffer, size_t size)
	307	{
	308	u8 *ptr = buffer;
	309	size_t length;
	310
	311	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
	312
	313	if (size < length)
	314	return -ENOSPC;
	315
3b390f62	316	memset(buffer, 0, size);
f142d3bd TR	317
	318	ptr[0] = frame->type;
	319	ptr[1] = frame->version;
	320	ptr[2] = frame->length;
	321	ptr[3] = 0; /* checksum */
	322
	323	memcpy(&ptr[HDMI_INFOFRAME_HEADER_SIZE], frame->data, frame->length);
	324
	325	hdmi_infoframe_checksum(buffer, length);
	326
	327	return length;
	328	}
	329	EXPORT_SYMBOL(hdmi_vendor_infoframe_pack);
72b09896 DL	330
	331	/**
	332	* hdmi_infoframe_pack() - write a HDMI infoframe to binary buffer
	333	* @frame: HDMI infoframe
	334	* @buffer: destination buffer
	335	* @size: size of buffer
	336	*
	337	* Packs the information contained in the @frame structure into a binary
	338	* representation that can be written into the corresponding controller
	339	* registers. Also computes the checksum as required by section 5.3.5 of
	340	* the HDMI 1.4 specification.
	341	*
	342	* Returns the number of bytes packed into the binary buffer or a negative
	343	* error code on failure.
	344	*/
	345	ssize_t
	346	hdmi_infoframe_pack(union hdmi_infoframe frame, void buffer, size_t size)
	347	{
	348	ssize_t length;
	349
	350	switch (frame->any.type) {
	351	case HDMI_INFOFRAME_TYPE_AVI:
	352	length = hdmi_avi_infoframe_pack(&frame->avi, buffer, size);
	353	break;
	354	case HDMI_INFOFRAME_TYPE_SPD:
	355	length = hdmi_spd_infoframe_pack(&frame->spd, buffer, size);
	356	break;
	357	case HDMI_INFOFRAME_TYPE_AUDIO:
	358	length = hdmi_audio_infoframe_pack(&frame->audio, buffer, size);
	359	break;
	360	case HDMI_INFOFRAME_TYPE_VENDOR:
	361	length = hdmi_vendor_infoframe_pack(&frame->vendor,
	362	buffer, size);
	363	break;
	364	default:
	365	WARN(1, "Bad infoframe type %d\n", frame->any.type);
	366	length = -EINVAL;
	367	}
	368
	369	return length;
	370	}
	371	EXPORT_SYMBOL(hdmi_infoframe_pack);