[deliverable/linux.git] / sound / pci / hda / hda_eld.c

/*
 * Generic routines and proc interface for ELD(EDID Like Data) information
 *
 * Copyright(c) 2008 Intel Corporation.
 *
 * Authors:
 * 		Wu Fengguang <wfg@linux.intel.com>
 *
 *  This driver is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This driver is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
 */

#include <linux/init.h>
#include <linux/slab.h>
#include <sound/core.h>
#include <asm/unaligned.h>
#include "hda_codec.h"
#include "hda_local.h"

enum eld_versions {
	ELD_VER_CEA_861D	= 2,
	ELD_VER_PARTIAL		= 31,
};

enum cea_edid_versions {
	CEA_EDID_VER_NONE	= 0,
	CEA_EDID_VER_CEA861	= 1,
	CEA_EDID_VER_CEA861A	= 2,
	CEA_EDID_VER_CEA861BCD	= 3,
	CEA_EDID_VER_RESERVED	= 4,
};

static char *cea_speaker_allocation_names[] = {
	/*  0 */ "FL/FR",
	/*  1 */ "LFE",
	/*  2 */ "FC",
	/*  3 */ "RL/RR",
	/*  4 */ "RC",
	/*  5 */ "FLC/FRC",
	/*  6 */ "RLC/RRC",
	/*  7 */ "FLW/FRW",
	/*  8 */ "FLH/FRH",
	/*  9 */ "TC",
	/* 10 */ "FCH",
};

static char *eld_connection_type_names[4] = {
	"HDMI",
	"DisplayPort",
	"2-reserved",
	"3-reserved"
};

enum cea_audio_coding_types {
	AUDIO_CODING_TYPE_REF_STREAM_HEADER	=  0,
	AUDIO_CODING_TYPE_LPCM			=  1,
	AUDIO_CODING_TYPE_AC3			=  2,
	AUDIO_CODING_TYPE_MPEG1			=  3,
	AUDIO_CODING_TYPE_MP3			=  4,
	AUDIO_CODING_TYPE_MPEG2			=  5,
	AUDIO_CODING_TYPE_AACLC			=  6,
	AUDIO_CODING_TYPE_DTS			=  7,
	AUDIO_CODING_TYPE_ATRAC			=  8,
	AUDIO_CODING_TYPE_SACD			=  9,
	AUDIO_CODING_TYPE_EAC3			= 10,
	AUDIO_CODING_TYPE_DTS_HD		= 11,
	AUDIO_CODING_TYPE_MLP			= 12,
	AUDIO_CODING_TYPE_DST			= 13,
	AUDIO_CODING_TYPE_WMAPRO		= 14,
	AUDIO_CODING_TYPE_REF_CXT		= 15,
	/* also include valid xtypes below */
	AUDIO_CODING_TYPE_HE_AAC		= 15,
	AUDIO_CODING_TYPE_HE_AAC2		= 16,
	AUDIO_CODING_TYPE_MPEG_SURROUND		= 17,
};

enum cea_audio_coding_xtypes {
	AUDIO_CODING_XTYPE_HE_REF_CT		= 0,
	AUDIO_CODING_XTYPE_HE_AAC		= 1,
	AUDIO_CODING_XTYPE_HE_AAC2		= 2,
	AUDIO_CODING_XTYPE_MPEG_SURROUND	= 3,
	AUDIO_CODING_XTYPE_FIRST_RESERVED	= 4,
};

static char *cea_audio_coding_type_names[] = {
	/*  0 */ "undefined",
	/*  1 */ "LPCM",
	/*  2 */ "AC-3",
	/*  3 */ "MPEG1",
	/*  4 */ "MP3",
	/*  5 */ "MPEG2",
	/*  6 */ "AAC-LC",
	/*  7 */ "DTS",
	/*  8 */ "ATRAC",
	/*  9 */ "DSD (One Bit Audio)",
	/* 10 */ "E-AC-3/DD+ (Dolby Digital Plus)",
	/* 11 */ "DTS-HD",
	/* 12 */ "MLP (Dolby TrueHD)",
	/* 13 */ "DST",
	/* 14 */ "WMAPro",
	/* 15 */ "HE-AAC",
	/* 16 */ "HE-AACv2",
	/* 17 */ "MPEG Surround",
};

/*
 * The following two lists are shared between
 * 	- HDMI audio InfoFrame (source to sink)
 * 	- CEA E-EDID Extension (sink to source)
 */

/*
 * SS1:SS0 index => sample size
 */
static int cea_sample_sizes[4] = {
	0,	 		/* 0: Refer to Stream Header */
	AC_SUPPCM_BITS_16,	/* 1: 16 bits */
	AC_SUPPCM_BITS_20,	/* 2: 20 bits */
	AC_SUPPCM_BITS_24,	/* 3: 24 bits */
};

/*
 * SF2:SF1:SF0 index => sampling frequency
 */
static int cea_sampling_frequencies[8] = {
	0,			/* 0: Refer to Stream Header */
	SNDRV_PCM_RATE_32000,	/* 1:  32000Hz */
	SNDRV_PCM_RATE_44100,	/* 2:  44100Hz */
	SNDRV_PCM_RATE_48000,	/* 3:  48000Hz */
	SNDRV_PCM_RATE_88200,	/* 4:  88200Hz */
	SNDRV_PCM_RATE_96000,	/* 5:  96000Hz */
	SNDRV_PCM_RATE_176400,	/* 6: 176400Hz */
	SNDRV_PCM_RATE_192000,	/* 7: 192000Hz */
};

static unsigned int hdmi_get_eld_data(struct hda_codec *codec, hda_nid_t nid,
					int byte_index)
{
	unsigned int val;

	val = snd_hda_codec_read(codec, nid, 0,
					AC_VERB_GET_HDMI_ELDD, byte_index);
#ifdef BE_PARANOID
	printk(KERN_INFO "HDMI: ELD data byte %d: 0x%x\n", byte_index, val);
#endif
	return val;
}

#define GRAB_BITS(buf, byte, lowbit, bits) 		\
({							\
	BUILD_BUG_ON(lowbit > 7);			\
	BUILD_BUG_ON(bits > 8);				\
	BUILD_BUG_ON(bits <= 0);			\
							\
	(buf[byte] >> (lowbit)) & ((1 << (bits)) - 1);	\
})

static void hdmi_update_short_audio_desc(struct cea_sad *a,
					 const unsigned char *buf)
{
	int i;
	int val;

	val = GRAB_BITS(buf, 1, 0, 7);
	a->rates = 0;
	for (i = 0; i < 7; i++)
		if (val & (1 << i))
			a->rates |= cea_sampling_frequencies[i + 1];

	a->channels = GRAB_BITS(buf, 0, 0, 3);
	a->channels++;

	a->sample_bits = 0;
	a->max_bitrate = 0;

	a->format = GRAB_BITS(buf, 0, 3, 4);
	switch (a->format) {
	case AUDIO_CODING_TYPE_REF_STREAM_HEADER:
		snd_printd(KERN_INFO
				"HDMI: audio coding type 0 not expected\n");
		break;

	case AUDIO_CODING_TYPE_LPCM:
		val = GRAB_BITS(buf, 2, 0, 3);
		for (i = 0; i < 3; i++)
			if (val & (1 << i))
				a->sample_bits |= cea_sample_sizes[i + 1];
		break;

	case AUDIO_CODING_TYPE_AC3:
	case AUDIO_CODING_TYPE_MPEG1:
	case AUDIO_CODING_TYPE_MP3:
	case AUDIO_CODING_TYPE_MPEG2:
	case AUDIO_CODING_TYPE_AACLC:
	case AUDIO_CODING_TYPE_DTS:
	case AUDIO_CODING_TYPE_ATRAC:
		a->max_bitrate = GRAB_BITS(buf, 2, 0, 8);
		a->max_bitrate *= 8000;
		break;

	case AUDIO_CODING_TYPE_SACD:
		break;

	case AUDIO_CODING_TYPE_EAC3:
		break;

	case AUDIO_CODING_TYPE_DTS_HD:
		break;

	case AUDIO_CODING_TYPE_MLP:
		break;

	case AUDIO_CODING_TYPE_DST:
		break;

	case AUDIO_CODING_TYPE_WMAPRO:
		a->profile = GRAB_BITS(buf, 2, 0, 3);
		break;

	case AUDIO_CODING_TYPE_REF_CXT:
		a->format = GRAB_BITS(buf, 2, 3, 5);
		if (a->format == AUDIO_CODING_XTYPE_HE_REF_CT ||
		    a->format >= AUDIO_CODING_XTYPE_FIRST_RESERVED) {
			snd_printd(KERN_INFO
				"HDMI: audio coding xtype %d not expected\n",
				a->format);
			a->format = 0;
		} else
			a->format += AUDIO_CODING_TYPE_HE_AAC -
				     AUDIO_CODING_XTYPE_HE_AAC;
		break;
	}
}

/*
 * Be careful, ELD buf could be totally rubbish!
 */
static int hdmi_update_eld(struct hdmi_eld *e,
			   const unsigned char *buf, int size)
{
	int mnl;
	int i;

	e->eld_ver = GRAB_BITS(buf, 0, 3, 5);
	if (e->eld_ver != ELD_VER_CEA_861D &&
	    e->eld_ver != ELD_VER_PARTIAL) {
		snd_printd(KERN_INFO "HDMI: Unknown ELD version %d\n",
								e->eld_ver);
		goto out_fail;
	}

	e->eld_size = size;
	e->baseline_len = GRAB_BITS(buf, 2, 0, 8);
	mnl		= GRAB_BITS(buf, 4, 0, 5);
	e->cea_edid_ver	= GRAB_BITS(buf, 4, 5, 3);

	e->support_hdcp	= GRAB_BITS(buf, 5, 0, 1);
	e->support_ai	= GRAB_BITS(buf, 5, 1, 1);
	e->conn_type	= GRAB_BITS(buf, 5, 2, 2);
	e->sad_count	= GRAB_BITS(buf, 5, 4, 4);

	e->aud_synch_delay = GRAB_BITS(buf, 6, 0, 8) * 2;
	e->spk_alloc	= GRAB_BITS(buf, 7, 0, 7);

	e->port_id	  = get_unaligned_le64(buf + 8);

	/* not specified, but the spec's tendency is little endian */
	e->manufacture_id = get_unaligned_le16(buf + 16);
	e->product_id	  = get_unaligned_le16(buf + 18);

	if (mnl > ELD_MAX_MNL) {
		snd_printd(KERN_INFO "HDMI: MNL is reserved value %d\n", mnl);
		goto out_fail;
	} else if (ELD_FIXED_BYTES + mnl > size) {
		snd_printd(KERN_INFO "HDMI: out of range MNL %d\n", mnl);
		goto out_fail;
	} else
		strlcpy(e->monitor_name, buf + ELD_FIXED_BYTES, mnl + 1);

	for (i = 0; i < e->sad_count; i++) {
		if (ELD_FIXED_BYTES + mnl + 3 * (i + 1) > size) {
			snd_printd(KERN_INFO "HDMI: out of range SAD %d\n", i);
			goto out_fail;
		}
		hdmi_update_short_audio_desc(e->sad + i,
					buf + ELD_FIXED_BYTES + mnl + 3 * i);
	}

	return 0;

out_fail:
	e->eld_ver = 0;
	return -EINVAL;
}

int snd_hdmi_get_eld_size(struct hda_codec *codec, hda_nid_t nid)
{
	return snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_HDMI_DIP_SIZE,
						 AC_DIPSIZE_ELD_BUF);
}

int snd_hdmi_get_eld(struct hdmi_eld *eld,
		     struct hda_codec *codec, hda_nid_t nid)
{
	int i;
	int ret;
	int size;
	unsigned char *buf;

	/*
	 * ELD size is initialized to zero in caller function. If no errors and
	 * ELD is valid, actual eld_size is assigned in hdmi_update_eld()
	 */

	if (!eld->eld_valid)
		return -ENOENT;

	size = snd_hdmi_get_eld_size(codec, nid);
	if (size == 0) {
		/* wfg: workaround for ASUS P5E-VM HDMI board */
		snd_printd(KERN_INFO "HDMI: ELD buf size is 0, force 128\n");
		size = 128;
	}
	if (size < ELD_FIXED_BYTES || size > ELD_MAX_SIZE) {
		snd_printd(KERN_INFO "HDMI: invalid ELD buf size %d\n", size);
		return -ERANGE;
	}

	/* set ELD buffer */
	buf = eld->eld_buffer;

	for (i = 0; i < size; i++) {
		unsigned int val = hdmi_get_eld_data(codec, nid, i);
		if (!(val & AC_ELDD_ELD_VALID)) {
			if (!i) {
				snd_printd(KERN_INFO
					   "HDMI: invalid ELD data\n");
				ret = -EINVAL;
				goto error;
			}
			snd_printd(KERN_INFO
				  "HDMI: invalid ELD data byte %d\n", i);
			val = 0;
		} else
			val &= AC_ELDD_ELD_DATA;
		buf[i] = val;
	}

	ret = hdmi_update_eld(eld, buf, size);

error:
	return ret;
}

static void hdmi_show_short_audio_desc(struct cea_sad *a)
{
	char buf[SND_PRINT_RATES_ADVISED_BUFSIZE];
	char buf2[8 + SND_PRINT_BITS_ADVISED_BUFSIZE] = ", bits =";

	if (!a->format)
		return;

	snd_print_pcm_rates(a->rates, buf, sizeof(buf));

	if (a->format == AUDIO_CODING_TYPE_LPCM)
		snd_print_pcm_bits(a->sample_bits, buf2 + 8, sizeof(buf2) - 8);
	else if (a->max_bitrate)
		snprintf(buf2, sizeof(buf2),
				", max bitrate = %d", a->max_bitrate);
	else
		buf2[0] = '\0';

	printk(KERN_INFO "HDMI: supports coding type %s:"
			" channels = %d, rates =%s%s\n",
			cea_audio_coding_type_names[a->format],
			a->channels,
			buf,
			buf2);
}

void snd_print_channel_allocation(int spk_alloc, char *buf, int buflen)
{
	int i, j;

	for (i = 0, j = 0; i < ARRAY_SIZE(cea_speaker_allocation_names); i++) {
		if (spk_alloc & (1 << i))
			j += snprintf(buf + j, buflen - j,  " %s",
					cea_speaker_allocation_names[i]);
	}
	buf[j] = '\0';	/* necessary when j == 0 */
}

void snd_hdmi_show_eld(struct hdmi_eld *e)
{
	int i;

	printk(KERN_INFO "HDMI: detected monitor %s at connection type %s\n",
			e->monitor_name,
			eld_connection_type_names[e->conn_type]);

	if (e->spk_alloc) {
		char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
		snd_print_channel_allocation(e->spk_alloc, buf, sizeof(buf));
		printk(KERN_INFO "HDMI: available speakers:%s\n", buf);
	}

	for (i = 0; i < e->sad_count; i++)
		hdmi_show_short_audio_desc(e->sad + i);
}

#ifdef CONFIG_PROC_FS

static void hdmi_print_sad_info(int i, struct cea_sad *a,
				struct snd_info_buffer *buffer)
{
	char buf[SND_PRINT_RATES_ADVISED_BUFSIZE];

	snd_iprintf(buffer, "sad%d_coding_type\t[0x%x] %s\n",
			i, a->format, cea_audio_coding_type_names[a->format]);
	snd_iprintf(buffer, "sad%d_channels\t\t%d\n", i, a->channels);

	snd_print_pcm_rates(a->rates, buf, sizeof(buf));
	snd_iprintf(buffer, "sad%d_rates\t\t[0x%x]%s\n", i, a->rates, buf);

	if (a->format == AUDIO_CODING_TYPE_LPCM) {
		snd_print_pcm_bits(a->sample_bits, buf, sizeof(buf));
		snd_iprintf(buffer, "sad%d_bits\t\t[0x%x]%s\n",
							i, a->sample_bits, buf);
	}

	if (a->max_bitrate)
		snd_iprintf(buffer, "sad%d_max_bitrate\t%d\n",
							i, a->max_bitrate);

	if (a->profile)
		snd_iprintf(buffer, "sad%d_profile\t\t%d\n", i, a->profile);
}

static void hdmi_print_eld_info(struct snd_info_entry *entry,
				struct snd_info_buffer *buffer)
{
	struct hdmi_eld *e = entry->private_data;
	char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
	int i;
	static char *eld_versoin_names[32] = {
		"reserved",
		"reserved",
		"CEA-861D or below",
		[3 ... 30] = "reserved",
		[31] = "partial"
	};
	static char *cea_edid_version_names[8] = {
		"no CEA EDID Timing Extension block present",
		"CEA-861",
		"CEA-861-A",
		"CEA-861-B, C or D",
		[4 ... 7] = "reserved"
	};

	snd_iprintf(buffer, "monitor_present\t\t%d\n", e->monitor_present);
	snd_iprintf(buffer, "eld_valid\t\t%d\n", e->eld_valid);
	if (!e->eld_valid)
		return;
	snd_iprintf(buffer, "monitor_name\t\t%s\n", e->monitor_name);
	snd_iprintf(buffer, "connection_type\t\t%s\n",
				eld_connection_type_names[e->conn_type]);
	snd_iprintf(buffer, "eld_version\t\t[0x%x] %s\n", e->eld_ver,
					eld_versoin_names[e->eld_ver]);
	snd_iprintf(buffer, "edid_version\t\t[0x%x] %s\n", e->cea_edid_ver,
				cea_edid_version_names[e->cea_edid_ver]);
	snd_iprintf(buffer, "manufacture_id\t\t0x%x\n", e->manufacture_id);
	snd_iprintf(buffer, "product_id\t\t0x%x\n", e->product_id);
	snd_iprintf(buffer, "port_id\t\t\t0x%llx\n", (long long)e->port_id);
	snd_iprintf(buffer, "support_hdcp\t\t%d\n", e->support_hdcp);
	snd_iprintf(buffer, "support_ai\t\t%d\n", e->support_ai);
	snd_iprintf(buffer, "audio_sync_delay\t%d\n", e->aud_synch_delay);

	snd_print_channel_allocation(e->spk_alloc, buf, sizeof(buf));
	snd_iprintf(buffer, "speakers\t\t[0x%x]%s\n", e->spk_alloc, buf);

	snd_iprintf(buffer, "sad_count\t\t%d\n", e->sad_count);

	for (i = 0; i < e->sad_count; i++)
		hdmi_print_sad_info(i, e->sad + i, buffer);
}

static void hdmi_write_eld_info(struct snd_info_entry *entry,
				struct snd_info_buffer *buffer)
{
	struct hdmi_eld *e = entry->private_data;
	char line[64];
	char name[64];
	char *sname;
	long long val;
	unsigned int n;

	while (!snd_info_get_line(buffer, line, sizeof(line))) {
		if (sscanf(line, "%s %llx", name, &val) != 2)
			continue;
		/*
		 * We don't allow modification to these fields:
		 * 	monitor_name manufacture_id product_id
		 * 	eld_version edid_version
		 */
		if (!strcmp(name, "monitor_present"))
			e->monitor_present = val;
		else if (!strcmp(name, "eld_valid"))
			e->eld_valid = val;
		else if (!strcmp(name, "connection_type"))
			e->conn_type = val;
		else if (!strcmp(name, "port_id"))
			e->port_id = val;
		else if (!strcmp(name, "support_hdcp"))
			e->support_hdcp = val;
		else if (!strcmp(name, "support_ai"))
			e->support_ai = val;
		else if (!strcmp(name, "audio_sync_delay"))
			e->aud_synch_delay = val;
		else if (!strcmp(name, "speakers"))
			e->spk_alloc = val;
		else if (!strcmp(name, "sad_count"))
			e->sad_count = val;
		else if (!strncmp(name, "sad", 3)) {
			sname = name + 4;
			n = name[3] - '0';
			if (name[4] >= '0' && name[4] <= '9') {
				sname++;
				n = 10 * n + name[4] - '0';
			}
			if (n >= ELD_MAX_SAD)
				continue;
			if (!strcmp(sname, "_coding_type"))
				e->sad[n].format = val;
			else if (!strcmp(sname, "_channels"))
				e->sad[n].channels = val;
			else if (!strcmp(sname, "_rates"))
				e->sad[n].rates = val;
			else if (!strcmp(sname, "_bits"))
				e->sad[n].sample_bits = val;
			else if (!strcmp(sname, "_max_bitrate"))
				e->sad[n].max_bitrate = val;
			else if (!strcmp(sname, "_profile"))
				e->sad[n].profile = val;
			if (n >= e->sad_count)
				e->sad_count = n + 1;
		}
	}
}


int snd_hda_eld_proc_new(struct hda_codec *codec, struct hdmi_eld *eld,
			 int index)
{
	char name[32];
	struct snd_info_entry *entry;
	int err;

	snprintf(name, sizeof(name), "eld#%d.%d", codec->addr, index);
	err = snd_card_proc_new(codec->bus->card, name, &entry);
	if (err < 0)
		return err;

	snd_info_set_text_ops(entry, eld, hdmi_print_eld_info);
	entry->c.text.write = hdmi_write_eld_info;
	entry->mode |= S_IWUSR;
	eld->proc_entry = entry;

	return 0;
}

void snd_hda_eld_proc_free(struct hda_codec *codec, struct hdmi_eld *eld)
{
	if (!codec->bus->shutdown && eld->proc_entry) {
		snd_device_free(codec->bus->card, eld->proc_entry);
		eld->proc_entry = NULL;
	}
}

#endif /* CONFIG_PROC_FS */

/* update PCM info based on ELD */
void snd_hdmi_eld_update_pcm_info(struct hdmi_eld *eld,
			      struct hda_pcm_stream *hinfo)
{
	u32 rates;
	u64 formats;
	unsigned int maxbps;
	unsigned int channels_max;
	int i;

	/* assume basic audio support (the basic audio flag is not in ELD;
	 * however, all audio capable sinks are required to support basic
	 * audio) */
	rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
		SNDRV_PCM_RATE_48000;
	formats = SNDRV_PCM_FMTBIT_S16_LE;
	maxbps = 16;
	channels_max = 2;
	for (i = 0; i < eld->sad_count; i++) {
		struct cea_sad *a = &eld->sad[i];
		rates |= a->rates;
		if (a->channels > channels_max)
			channels_max = a->channels;
		if (a->format == AUDIO_CODING_TYPE_LPCM) {
			if (a->sample_bits & AC_SUPPCM_BITS_20) {
				formats |= SNDRV_PCM_FMTBIT_S32_LE;
				if (maxbps < 20)
					maxbps = 20;
			}
			if (a->sample_bits & AC_SUPPCM_BITS_24) {
				formats |= SNDRV_PCM_FMTBIT_S32_LE;
				if (maxbps < 24)
					maxbps = 24;
			}
		}
	}

	/* restrict the parameters by the values the codec provides */
	hinfo->rates &= rates;
	hinfo->formats &= formats;
	hinfo->maxbps = min(hinfo->maxbps, maxbps);
	hinfo->channels_max = min(hinfo->channels_max, channels_max);
}
Commit	Line	Data
7f4a9f43 WF	1	/*
	2	* Generic routines and proc interface for ELD(EDID Like Data) information
	3	*
	4	* Copyright(c) 2008 Intel Corporation.
	5	*
	6	* Authors:
	7	* Wu Fengguang <wfg@linux.intel.com>
	8	*
	9	* This driver is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License as published by
	11	* the Free Software Foundation; either version 2 of the License, or
	12	* (at your option) any later version.
	13	*
	14	* This driver is distributed in the hope that it will be useful,
	15	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	17	* GNU General Public License for more details.
	18	*
	19	* You should have received a copy of the GNU General Public License
	20	* along with this program; if not, write to the Free Software
	21	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	22	*/
	23
	24	#include <linux/init.h>
5a0e3ad6	25	#include <linux/slab.h>
7f4a9f43 WF	26	#include <sound/core.h>
	27	#include <asm/unaligned.h>
	28	#include "hda_codec.h"
	29	#include "hda_local.h"
	30
	31	enum eld_versions {
	32	ELD_VER_CEA_861D = 2,
	33	ELD_VER_PARTIAL = 31,
	34	};
	35
7f4a9f43 WF	36	enum cea_edid_versions {
	37	CEA_EDID_VER_NONE = 0,
	38	CEA_EDID_VER_CEA861 = 1,
	39	CEA_EDID_VER_CEA861A = 2,
	40	CEA_EDID_VER_CEA861BCD = 3,
	41	CEA_EDID_VER_RESERVED = 4,
	42	};
	43
7f4a9f43 WF	44	static char *cea_speaker_allocation_names[] = {
	45	/* 0 */ "FL/FR",
	46	/* 1 */ "LFE",
	47	/* 2 */ "FC",
	48	/* 3 */ "RL/RR",
	49	/* 4 */ "RC",
	50	/* 5 */ "FLC/FRC",
	51	/* 6 */ "RLC/RRC",
	52	/* 7 */ "FLW/FRW",
	53	/* 8 */ "FLH/FRH",
	54	/* 9 */ "TC",
	55	/* 10 */ "FCH",
	56	};
	57
	58	static char *eld_connection_type_names[4] = {
	59	"HDMI",
9415e1c4	60	"DisplayPort",
7f4a9f43 WF	61	"2-reserved",
	62	"3-reserved"
	63	};
	64
	65	enum cea_audio_coding_types {
	66	AUDIO_CODING_TYPE_REF_STREAM_HEADER = 0,
	67	AUDIO_CODING_TYPE_LPCM = 1,
	68	AUDIO_CODING_TYPE_AC3 = 2,
	69	AUDIO_CODING_TYPE_MPEG1 = 3,
	70	AUDIO_CODING_TYPE_MP3 = 4,
	71	AUDIO_CODING_TYPE_MPEG2 = 5,
	72	AUDIO_CODING_TYPE_AACLC = 6,
	73	AUDIO_CODING_TYPE_DTS = 7,
	74	AUDIO_CODING_TYPE_ATRAC = 8,
	75	AUDIO_CODING_TYPE_SACD = 9,
	76	AUDIO_CODING_TYPE_EAC3 = 10,
	77	AUDIO_CODING_TYPE_DTS_HD = 11,
	78	AUDIO_CODING_TYPE_MLP = 12,
	79	AUDIO_CODING_TYPE_DST = 13,
	80	AUDIO_CODING_TYPE_WMAPRO = 14,
	81	AUDIO_CODING_TYPE_REF_CXT = 15,
	82	/* also include valid xtypes below */
	83	AUDIO_CODING_TYPE_HE_AAC = 15,
	84	AUDIO_CODING_TYPE_HE_AAC2 = 16,
	85	AUDIO_CODING_TYPE_MPEG_SURROUND = 17,
	86	};
	87
	88	enum cea_audio_coding_xtypes {
	89	AUDIO_CODING_XTYPE_HE_REF_CT = 0,
	90	AUDIO_CODING_XTYPE_HE_AAC = 1,
	91	AUDIO_CODING_XTYPE_HE_AAC2 = 2,
	92	AUDIO_CODING_XTYPE_MPEG_SURROUND = 3,
	93	AUDIO_CODING_XTYPE_FIRST_RESERVED = 4,
	94	};
	95
	96	static char *cea_audio_coding_type_names[] = {
	97	/* 0 */ "undefined",
	98	/* 1 */ "LPCM",
	99	/* 2 */ "AC-3",
	100	/* 3 */ "MPEG1",
	101	/* 4 */ "MP3",
	102	/* 5 */ "MPEG2",
	103	/* 6 */ "AAC-LC",
	104	/* 7 */ "DTS",
	105	/* 8 */ "ATRAC",
06f69d17	106	/* 9 */ "DSD (One Bit Audio)",
7f4a9f43 WF	107	/* 10 */ "E-AC-3/DD+ (Dolby Digital Plus)",
	108	/* 11 */ "DTS-HD",
	109	/* 12 */ "MLP (Dolby TrueHD)",
	110	/* 13 */ "DST",
	111	/* 14 */ "WMAPro",
	112	/* 15 */ "HE-AAC",
	113	/* 16 */ "HE-AACv2",
	114	/* 17 */ "MPEG Surround",
	115	};
	116
	117	/*
	118	* The following two lists are shared between
	119	* - HDMI audio InfoFrame (source to sink)
4e19c58f	120	* - CEA E-EDID Extension (sink to source)
7f4a9f43 WF	121	*/
	122
	123	/*
	124	* SS1:SS0 index => sample size
	125	*/
	126	static int cea_sample_sizes[4] = {
	127	0, /* 0: Refer to Stream Header */
	128	AC_SUPPCM_BITS_16, /* 1: 16 bits */
	129	AC_SUPPCM_BITS_20, /* 2: 20 bits */
	130	AC_SUPPCM_BITS_24, /* 3: 24 bits */
	131	};
	132
	133	/*
	134	* SF2:SF1:SF0 index => sampling frequency
	135	*/
	136	static int cea_sampling_frequencies[8] = {
	137	0, /* 0: Refer to Stream Header */
	138	SNDRV_PCM_RATE_32000, /* 1: 32000Hz */
	139	SNDRV_PCM_RATE_44100, /* 2: 44100Hz */
	140	SNDRV_PCM_RATE_48000, /* 3: 48000Hz */
	141	SNDRV_PCM_RATE_88200, /* 4: 88200Hz */
	142	SNDRV_PCM_RATE_96000, /* 5: 96000Hz */
	143	SNDRV_PCM_RATE_176400, /* 6: 176400Hz */
	144	SNDRV_PCM_RATE_192000, /* 7: 192000Hz */
	145	};
	146
b6acf013	147	static unsigned int hdmi_get_eld_data(struct hda_codec *codec, hda_nid_t nid,
7f4a9f43 WF	148	int byte_index)
	149	{
	150	unsigned int val;
	151
	152	val = snd_hda_codec_read(codec, nid, 0,
	153	AC_VERB_GET_HDMI_ELDD, byte_index);
7f4a9f43	154	#ifdef BE_PARANOID
03284c8f	155	printk(KERN_INFO "HDMI: ELD data byte %d: 0x%x\n", byte_index, val);
7f4a9f43	156	#endif
b6acf013	157	return val;
7f4a9f43 WF	158	}
	159
	160	#define GRAB_BITS(buf, byte, lowbit, bits) \
	161	({ \
	162	BUILD_BUG_ON(lowbit > 7); \
	163	BUILD_BUG_ON(bits > 8); \
	164	BUILD_BUG_ON(bits <= 0); \
	165	\
	166	(buf[byte] >> (lowbit)) & ((1 << (bits)) - 1); \
	167	})
	168
	169	static void hdmi_update_short_audio_desc(struct cea_sad *a,
	170	const unsigned char *buf)
	171	{
	172	int i;
	173	int val;
	174
	175	val = GRAB_BITS(buf, 1, 0, 7);
	176	a->rates = 0;
	177	for (i = 0; i < 7; i++)
	178	if (val & (1 << i))
	179	a->rates \|= cea_sampling_frequencies[i + 1];
	180
	181	a->channels = GRAB_BITS(buf, 0, 0, 3);
	182	a->channels++;
	183
0bbaee3a AH	184	a->sample_bits = 0;
	185	a->max_bitrate = 0;
	186
7f4a9f43 WF	187	a->format = GRAB_BITS(buf, 0, 3, 4);
	188	switch (a->format) {
	189	case AUDIO_CODING_TYPE_REF_STREAM_HEADER:
	190	snd_printd(KERN_INFO
03284c8f	191	"HDMI: audio coding type 0 not expected\n");
7f4a9f43 WF	192	break;
	193
	194	case AUDIO_CODING_TYPE_LPCM:
	195	val = GRAB_BITS(buf, 2, 0, 3);
7f4a9f43 WF	196	for (i = 0; i < 3; i++)
	197	if (val & (1 << i))
	198	a->sample_bits \|= cea_sample_sizes[i + 1];
	199	break;
	200
	201	case AUDIO_CODING_TYPE_AC3:
	202	case AUDIO_CODING_TYPE_MPEG1:
	203	case AUDIO_CODING_TYPE_MP3:
	204	case AUDIO_CODING_TYPE_MPEG2:
	205	case AUDIO_CODING_TYPE_AACLC:
	206	case AUDIO_CODING_TYPE_DTS:
	207	case AUDIO_CODING_TYPE_ATRAC:
	208	a->max_bitrate = GRAB_BITS(buf, 2, 0, 8);
	209	a->max_bitrate *= 8000;
	210	break;
	211
	212	case AUDIO_CODING_TYPE_SACD:
	213	break;
	214
	215	case AUDIO_CODING_TYPE_EAC3:
	216	break;
	217
	218	case AUDIO_CODING_TYPE_DTS_HD:
	219	break;
	220
	221	case AUDIO_CODING_TYPE_MLP:
	222	break;
	223
	224	case AUDIO_CODING_TYPE_DST:
	225	break;
	226
	227	case AUDIO_CODING_TYPE_WMAPRO:
	228	a->profile = GRAB_BITS(buf, 2, 0, 3);
	229	break;
	230
	231	case AUDIO_CODING_TYPE_REF_CXT:
	232	a->format = GRAB_BITS(buf, 2, 3, 5);
	233	if (a->format == AUDIO_CODING_XTYPE_HE_REF_CT \|\|
	234	a->format >= AUDIO_CODING_XTYPE_FIRST_RESERVED) {
	235	snd_printd(KERN_INFO
03284c8f	236	"HDMI: audio coding xtype %d not expected\n",
7f4a9f43 WF	237	a->format);
	238	a->format = 0;
	239	} else
	240	a->format += AUDIO_CODING_TYPE_HE_AAC -
	241	AUDIO_CODING_XTYPE_HE_AAC;
	242	break;
	243	}
	244	}
	245
	246	/*
	247	* Be careful, ELD buf could be totally rubbish!
	248	*/
5b87ebb7 WF	249	static int hdmi_update_eld(struct hdmi_eld *e,
5b87ebb7 WF	250	const unsigned char *buf, int size)
7f4a9f43 WF	251	{
	252	int mnl;
	253	int i;
	254
	255	e->eld_ver = GRAB_BITS(buf, 0, 3, 5);
	256	if (e->eld_ver != ELD_VER_CEA_861D &&
	257	e->eld_ver != ELD_VER_PARTIAL) {
03284c8f WF	258	snd_printd(KERN_INFO "HDMI: Unknown ELD version %d\n",
03284c8f WF	259	e->eld_ver);
7f4a9f43 WF	260	goto out_fail;
	261	}
	262
	263	e->eld_size = size;
	264	e->baseline_len = GRAB_BITS(buf, 2, 0, 8);
	265	mnl = GRAB_BITS(buf, 4, 0, 5);
	266	e->cea_edid_ver = GRAB_BITS(buf, 4, 5, 3);
	267
	268	e->support_hdcp = GRAB_BITS(buf, 5, 0, 1);
	269	e->support_ai = GRAB_BITS(buf, 5, 1, 1);
	270	e->conn_type = GRAB_BITS(buf, 5, 2, 2);
	271	e->sad_count = GRAB_BITS(buf, 5, 4, 4);
	272
	273	e->aud_synch_delay = GRAB_BITS(buf, 6, 0, 8) * 2;
	274	e->spk_alloc = GRAB_BITS(buf, 7, 0, 7);
	275
	276	e->port_id = get_unaligned_le64(buf + 8);
	277
	278	/* not specified, but the spec's tendency is little endian */
	279	e->manufacture_id = get_unaligned_le16(buf + 16);
	280	e->product_id = get_unaligned_le16(buf + 18);
	281
	282	if (mnl > ELD_MAX_MNL) {
03284c8f	283	snd_printd(KERN_INFO "HDMI: MNL is reserved value %d\n", mnl);
7f4a9f43 WF	284	goto out_fail;
7f4a9f43 WF	285	} else if (ELD_FIXED_BYTES + mnl > size) {
03284c8f	286	snd_printd(KERN_INFO "HDMI: out of range MNL %d\n", mnl);
7f4a9f43 WF	287	goto out_fail;
7f4a9f43 WF	288	} else
f5b2d0ef	289	strlcpy(e->monitor_name, buf + ELD_FIXED_BYTES, mnl + 1);
7f4a9f43 WF	290
	291	for (i = 0; i < e->sad_count; i++) {
	292	if (ELD_FIXED_BYTES + mnl + 3 * (i + 1) > size) {
03284c8f	293	snd_printd(KERN_INFO "HDMI: out of range SAD %d\n", i);
7f4a9f43 WF	294	goto out_fail;
	295	}
	296	hdmi_update_short_audio_desc(e->sad + i,
	297	buf + ELD_FIXED_BYTES + mnl + 3 * i);
	298	}
	299
	300	return 0;
	301
	302	out_fail:
	303	e->eld_ver = 0;
	304	return -EINVAL;
	305	}
	306
7f4a9f43 WF	307	int snd_hdmi_get_eld_size(struct hda_codec *codec, hda_nid_t nid)
	308	{
	309	return snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_HDMI_DIP_SIZE,
	310	AC_DIPSIZE_ELD_BUF);
	311	}
	312
5b87ebb7	313	int snd_hdmi_get_eld(struct hdmi_eld *eld,
7f4a9f43 WF	314	struct hda_codec *codec, hda_nid_t nid)
	315	{
	316	int i;
	317	int ret;
	318	int size;
	319	unsigned char *buf;
	320
14bc52b8 PLB	321	/*
	322	* ELD size is initialized to zero in caller function. If no errors and
	323	* ELD is valid, actual eld_size is assigned in hdmi_update_eld()
	324	*/
	325
5d44f927	326	if (!eld->eld_valid)
7f4a9f43 WF	327	return -ENOENT;
	328
	329	size = snd_hdmi_get_eld_size(codec, nid);
	330	if (size == 0) {
	331	/* wfg: workaround for ASUS P5E-VM HDMI board */
03284c8f	332	snd_printd(KERN_INFO "HDMI: ELD buf size is 0, force 128\n");
7f4a9f43 WF	333	size = 128;
7f4a9f43 WF	334	}
14bc52b8	335	if (size < ELD_FIXED_BYTES \|\| size > ELD_MAX_SIZE) {
03284c8f	336	snd_printd(KERN_INFO "HDMI: invalid ELD buf size %d\n", size);
7f4a9f43 WF	337	return -ERANGE;
	338	}
	339
14bc52b8 PLB	340	/* set ELD buffer */
14bc52b8 PLB	341	buf = eld->eld_buffer;
7f4a9f43	342
b6acf013 TI	343	for (i = 0; i < size; i++) {
	344	unsigned int val = hdmi_get_eld_data(codec, nid, i);
	345	if (!(val & AC_ELDD_ELD_VALID)) {
	346	if (!i) {
	347	snd_printd(KERN_INFO
	348	"HDMI: invalid ELD data\n");
	349	ret = -EINVAL;
	350	goto error;
	351	}
	352	snd_printd(KERN_INFO
	353	"HDMI: invalid ELD data byte %d\n", i);
	354	val = 0;
	355	} else
	356	val &= AC_ELDD_ELD_DATA;
	357	buf[i] = val;
	358	}
7f4a9f43	359
5b87ebb7	360	ret = hdmi_update_eld(eld, buf, size);
7f4a9f43	361
b6acf013	362	error:
7f4a9f43 WF	363	return ret;
	364	}
	365
	366	static void hdmi_show_short_audio_desc(struct cea_sad *a)
	367	{
	368	char buf[SND_PRINT_RATES_ADVISED_BUFSIZE];
ae8cb4ca	369	char buf2[8 + SND_PRINT_BITS_ADVISED_BUFSIZE] = ", bits =";
7f4a9f43	370
ae8cb4ca WF	371	if (!a->format)
ae8cb4ca WF	372	return;
7f4a9f43 WF	373
7f4a9f43 WF	374	snd_print_pcm_rates(a->rates, buf, sizeof(buf));
7f4a9f43 WF	375
7f4a9f43 WF	376	if (a->format == AUDIO_CODING_TYPE_LPCM)
d757534e	377	snd_print_pcm_bits(a->sample_bits, buf2 + 8, sizeof(buf2) - 8);
ae8cb4ca WF	378	else if (a->max_bitrate)
	379	snprintf(buf2, sizeof(buf2),
	380	", max bitrate = %d", a->max_bitrate);
	381	else
	382	buf2[0] = '\0';
	383
03284c8f	384	printk(KERN_INFO "HDMI: supports coding type %s:"
ae8cb4ca WF	385	" channels = %d, rates =%s%s\n",
	386	cea_audio_coding_type_names[a->format],
	387	a->channels,
	388	buf,
	389	buf2);
7f4a9f43 WF	390	}
7f4a9f43 WF	391
903b21d8	392	void snd_print_channel_allocation(int spk_alloc, char *buf, int buflen)
7f4a9f43 WF	393	{
	394	int i, j;
	395
	396	for (i = 0, j = 0; i < ARRAY_SIZE(cea_speaker_allocation_names); i++) {
	397	if (spk_alloc & (1 << i))
06f69d17	398	j += snprintf(buf + j, buflen - j, " %s",
7f4a9f43 WF	399	cea_speaker_allocation_names[i]);
7f4a9f43 WF	400	}
7f4a9f43 WF	401	buf[j] = '\0'; /* necessary when j == 0 */
	402	}
	403
5b87ebb7	404	void snd_hdmi_show_eld(struct hdmi_eld *e)
7f4a9f43 WF	405	{
7f4a9f43 WF	406	int i;
ae8cb4ca	407
03284c8f	408	printk(KERN_INFO "HDMI: detected monitor %s at connection type %s\n",
ae8cb4ca WF	409	e->monitor_name,
	410	eld_connection_type_names[e->conn_type]);
	411
	412	if (e->spk_alloc) {
	413	char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
	414	snd_print_channel_allocation(e->spk_alloc, buf, sizeof(buf));
03284c8f	415	printk(KERN_INFO "HDMI: available speakers:%s\n", buf);
ae8cb4ca	416	}
7f4a9f43 WF	417
	418	for (i = 0; i < e->sad_count; i++)
	419	hdmi_show_short_audio_desc(e->sad + i);
	420	}
5f1e71b1 WF	421
	422	#ifdef CONFIG_PROC_FS
	423
	424	static void hdmi_print_sad_info(int i, struct cea_sad *a,
	425	struct snd_info_buffer *buffer)
	426	{
d39b4352	427	char buf[SND_PRINT_RATES_ADVISED_BUFSIZE];
5f1e71b1 WF	428
	429	snd_iprintf(buffer, "sad%d_coding_type\t[0x%x] %s\n",
	430	i, a->format, cea_audio_coding_type_names[a->format]);
	431	snd_iprintf(buffer, "sad%d_channels\t\t%d\n", i, a->channels);
	432
	433	snd_print_pcm_rates(a->rates, buf, sizeof(buf));
06f69d17	434	snd_iprintf(buffer, "sad%d_rates\t\t[0x%x]%s\n", i, a->rates, buf);
5f1e71b1	435
d39b4352 WF	436	if (a->format == AUDIO_CODING_TYPE_LPCM) {
	437	snd_print_pcm_bits(a->sample_bits, buf, sizeof(buf));
	438	snd_iprintf(buffer, "sad%d_bits\t\t[0x%x]%s\n",
	439	i, a->sample_bits, buf);
	440	}
5f1e71b1 WF	441
	442	if (a->max_bitrate)
	443	snd_iprintf(buffer, "sad%d_max_bitrate\t%d\n",
	444	i, a->max_bitrate);
	445
	446	if (a->profile)
	447	snd_iprintf(buffer, "sad%d_profile\t\t%d\n", i, a->profile);
	448	}
	449
	450	static void hdmi_print_eld_info(struct snd_info_entry *entry,
	451	struct snd_info_buffer *buffer)
	452	{
5b87ebb7	453	struct hdmi_eld *e = entry->private_data;
903b21d8	454	char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
5f1e71b1	455	int i;
4805286b WF	456	static char *eld_versoin_names[32] = {
	457	"reserved",
	458	"reserved",
	459	"CEA-861D or below",
	460	[3 ... 30] = "reserved",
	461	[31] = "partial"
	462	};
	463	static char *cea_edid_version_names[8] = {
	464	"no CEA EDID Timing Extension block present",
	465	"CEA-861",
	466	"CEA-861-A",
	467	"CEA-861-B, C or D",
	468	[4 ... 7] = "reserved"
	469	};
5f1e71b1	470
23ccc2bd WF	471	snd_iprintf(buffer, "monitor_present\t\t%d\n", e->monitor_present);
23ccc2bd WF	472	snd_iprintf(buffer, "eld_valid\t\t%d\n", e->eld_valid);
5d44f927 SW	473	if (!e->eld_valid)
5d44f927 SW	474	return;
db742104	475	snd_iprintf(buffer, "monitor_name\t\t%s\n", e->monitor_name);
5f1e71b1 WF	476	snd_iprintf(buffer, "connection_type\t\t%s\n",
	477	eld_connection_type_names[e->conn_type]);
	478	snd_iprintf(buffer, "eld_version\t\t[0x%x] %s\n", e->eld_ver,
	479	eld_versoin_names[e->eld_ver]);
	480	snd_iprintf(buffer, "edid_version\t\t[0x%x] %s\n", e->cea_edid_ver,
	481	cea_edid_version_names[e->cea_edid_ver]);
	482	snd_iprintf(buffer, "manufacture_id\t\t0x%x\n", e->manufacture_id);
	483	snd_iprintf(buffer, "product_id\t\t0x%x\n", e->product_id);
	484	snd_iprintf(buffer, "port_id\t\t\t0x%llx\n", (long long)e->port_id);
	485	snd_iprintf(buffer, "support_hdcp\t\t%d\n", e->support_hdcp);
	486	snd_iprintf(buffer, "support_ai\t\t%d\n", e->support_ai);
	487	snd_iprintf(buffer, "audio_sync_delay\t%d\n", e->aud_synch_delay);
	488
903b21d8	489	snd_print_channel_allocation(e->spk_alloc, buf, sizeof(buf));
06f69d17	490	snd_iprintf(buffer, "speakers\t\t[0x%x]%s\n", e->spk_alloc, buf);
5f1e71b1 WF	491
	492	snd_iprintf(buffer, "sad_count\t\t%d\n", e->sad_count);
	493
	494	for (i = 0; i < e->sad_count; i++)
	495	hdmi_print_sad_info(i, e->sad + i, buffer);
	496	}
	497
acb05993	498	static void hdmi_write_eld_info(struct snd_info_entry *entry,
acdda791 WF	499	struct snd_info_buffer *buffer)
	500	{
	501	struct hdmi_eld *e = entry->private_data;
	502	char line[64];
	503	char name[64];
	504	char *sname;
	505	long long val;
78735cff	506	unsigned int n;
acdda791 WF	507
	508	while (!snd_info_get_line(buffer, line, sizeof(line))) {
	509	if (sscanf(line, "%s %llx", name, &val) != 2)
	510	continue;
acb05993 WF	511	/*
	512	* We don't allow modification to these fields:
	513	* monitor_name manufacture_id product_id
	514	* eld_version edid_version
	515	*/
23ccc2bd WF	516	if (!strcmp(name, "monitor_present"))
	517	e->monitor_present = val;
	518	else if (!strcmp(name, "eld_valid"))
	519	e->eld_valid = val;
	520	else if (!strcmp(name, "connection_type"))
acdda791 WF	521	e->conn_type = val;
	522	else if (!strcmp(name, "port_id"))
	523	e->port_id = val;
	524	else if (!strcmp(name, "support_hdcp"))
	525	e->support_hdcp = val;
	526	else if (!strcmp(name, "support_ai"))
	527	e->support_ai = val;
	528	else if (!strcmp(name, "audio_sync_delay"))
	529	e->aud_synch_delay = val;
	530	else if (!strcmp(name, "speakers"))
	531	e->spk_alloc = val;
	532	else if (!strcmp(name, "sad_count"))
	533	e->sad_count = val;
	534	else if (!strncmp(name, "sad", 3)) {
	535	sname = name + 4;
	536	n = name[3] - '0';
	537	if (name[4] >= '0' && name[4] <= '9') {
	538	sname++;
	539	n = 10 * n + name[4] - '0';
	540	}
78735cff	541	if (n >= ELD_MAX_SAD)
acdda791 WF	542	continue;
	543	if (!strcmp(sname, "_coding_type"))
	544	e->sad[n].format = val;
	545	else if (!strcmp(sname, "_channels"))
	546	e->sad[n].channels = val;
	547	else if (!strcmp(sname, "_rates"))
	548	e->sad[n].rates = val;
	549	else if (!strcmp(sname, "_bits"))
	550	e->sad[n].sample_bits = val;
	551	else if (!strcmp(sname, "_max_bitrate"))
	552	e->sad[n].max_bitrate = val;
acb05993 WF	553	else if (!strcmp(sname, "_profile"))
acb05993 WF	554	e->sad[n].profile = val;
acdda791 WF	555	if (n >= e->sad_count)
	556	e->sad_count = n + 1;
	557	}
	558	}
	559	}
	560
	561
54a25f87 WF	562	int snd_hda_eld_proc_new(struct hda_codec codec, struct hdmi_eld eld,
54a25f87 WF	563	int index)
5f1e71b1 WF	564	{
	565	char name[32];
	566	struct snd_info_entry *entry;
	567	int err;
	568
54a25f87	569	snprintf(name, sizeof(name), "eld#%d.%d", codec->addr, index);
5f1e71b1 WF	570	err = snd_card_proc_new(codec->bus->card, name, &entry);
	571	if (err < 0)
	572	return err;
	573
	574	snd_info_set_text_ops(entry, eld, hdmi_print_eld_info);
acb05993	575	entry->c.text.write = hdmi_write_eld_info;
acdda791	576	entry->mode \|= S_IWUSR;
f208dba9	577	eld->proc_entry = entry;
acdda791	578
5f1e71b1 WF	579	return 0;
	580	}
	581
f208dba9 TI	582	void snd_hda_eld_proc_free(struct hda_codec codec, struct hdmi_eld eld)
	583	{
	584	if (!codec->bus->shutdown && eld->proc_entry) {
	585	snd_device_free(codec->bus->card, eld->proc_entry);
	586	eld->proc_entry = NULL;
	587	}
	588	}
	589
274714f5 TI	590	#endif /* CONFIG_PROC_FS */
274714f5 TI	591
bbbe3390	592	/* update PCM info based on ELD */
2def8172 SW	593	void snd_hdmi_eld_update_pcm_info(struct hdmi_eld *eld,
2def8172 SW	594	struct hda_pcm_stream *hinfo)
bbbe3390	595	{
2def8172 SW	596	u32 rates;
	597	u64 formats;
	598	unsigned int maxbps;
	599	unsigned int channels_max;
bbbe3390 TI	600	int i;
bbbe3390 TI	601
3dc86429 AH	602	/* assume basic audio support (the basic audio flag is not in ELD;
	603	* however, all audio capable sinks are required to support basic
	604	* audio) */
2def8172 SW	605	rates = SNDRV_PCM_RATE_32000 \| SNDRV_PCM_RATE_44100 \|
	606	SNDRV_PCM_RATE_48000;
	607	formats = SNDRV_PCM_FMTBIT_S16_LE;
	608	maxbps = 16;
	609	channels_max = 2;
bbbe3390 TI	610	for (i = 0; i < eld->sad_count; i++) {
bbbe3390 TI	611	struct cea_sad *a = &eld->sad[i];
2def8172 SW	612	rates \|= a->rates;
	613	if (a->channels > channels_max)
	614	channels_max = a->channels;
bbbe3390	615	if (a->format == AUDIO_CODING_TYPE_LPCM) {
bbbe3390	616	if (a->sample_bits & AC_SUPPCM_BITS_20) {
2def8172 SW	617	formats \|= SNDRV_PCM_FMTBIT_S32_LE;
	618	if (maxbps < 20)
	619	maxbps = 20;
bbbe3390 TI	620	}
bbbe3390 TI	621	if (a->sample_bits & AC_SUPPCM_BITS_24) {
2def8172 SW	622	formats \|= SNDRV_PCM_FMTBIT_S32_LE;
	623	if (maxbps < 24)
	624	maxbps = 24;
bbbe3390 TI	625	}
	626	}
	627	}
	628
bbbe3390	629	/* restrict the parameters by the values the codec provides */
2def8172 SW	630	hinfo->rates &= rates;
	631	hinfo->formats &= formats;
	632	hinfo->maxbps = min(hinfo->maxbps, maxbps);
	633	hinfo->channels_max = min(hinfo->channels_max, channels_max);
bbbe3390	634	}