On 12/11/2016 07:09 AM, Takashi Sakamoto wrote:
On Dec 9 2016 01:37, Arnaud Pouliquen wrote:
Add user interface to provide channel mapping. In a first step this control is read only.
As TLV type, the control provides all configurations available for HDMI sink(ELD), and provides current channel mapping selected by codec based on ELD and number of channels specified by user on open. When control is called before the number of the channel is specified (i.e. hw_params is set), it returns all channels set to UNKNOWN.
Notice that SNDRV_CTL_TLVT_CHMAP_FIXED is used for all mappings, as no information is available from HDMI driver to allow channel swapping.
Signed-off-by: Arnaud Pouliquen arnaud.pouliquen@st.com
sound/soc/codecs/hdmi-codec.c | 346 +++++++++++++++++++++++++++++++++++++++++- 1 file changed, 345 insertions(+), 1 deletion(-)
diff --git a/sound/soc/codecs/hdmi-codec.c b/sound/soc/codecs/hdmi-codec.c index f27d115..0cb83a3 100644 --- a/sound/soc/codecs/hdmi-codec.c +++ b/sound/soc/codecs/hdmi-codec.c @@ -18,12 +18,137 @@ #include <sound/pcm.h> #include <sound/pcm_params.h> #include <sound/soc.h> +#include <sound/tlv.h> #include <sound/pcm_drm_eld.h> #include <sound/hdmi-codec.h> #include <sound/pcm_iec958.h>
#include <drm/drm_crtc.h> /* This is only to get MAX_ELD_BYTES */
+#define HDMI_MAX_SPEAKERS 8
+/*
- CEA speaker placement for HDMI 1.4:
- FL FLC FC FRC FR FRW
LFE
- RL RLC RC RRC RR
- Speaker placement has to be extended to support HDMI 2.0
- */
+enum hdmi_codec_cea_spk_placement {
- FL = (1 << 0), /* Front Left */
- FC = (1 << 1), /* Front Center */
- FR = (1 << 2), /* Front Right */
- FLC = (1 << 3), /* Front Left Center */
- FRC = (1 << 4), /* Front Right Center */
- RL = (1 << 5), /* Rear Left */
- RC = (1 << 6), /* Rear Center */
- RR = (1 << 7), /* Rear Right */
- RLC = (1 << 8), /* Rear Left Center */
- RRC = (1 << 9), /* Rear Right Center */
- LFE = (1 << 10), /* Low Frequency Effect */
+};
BIT() macro in "linux/bitops.h" is available.
will be corrected in a v2
+/*
- ELD Speaker allocation bits in the CEA Speaker Allocation data block
- */
+static int hdmi_codec_eld_spk_alloc_bits[] = {
- [0] = FL | FR,
- [1] = LFE,
- [2] = FC,
- [3] = RL | RR,
- [4] = RC,
- [5] = FLC | FRC,
- [6] = RLC | RRC,
+};
Please put this kind of invariant table into .rodata section with 'const' modifier.
will be corrected in a v2
+struct hdmi_codec_channel_map_table {
- unsigned char map; /* ALSA API channel map position */
- int spk_mask; /* speaker position bit mask */
+};
+static struct hdmi_codec_channel_map_table hdmi_codec_map_table[] = {
- { SNDRV_CHMAP_FL, FL },
- { SNDRV_CHMAP_FR, FR },
- { SNDRV_CHMAP_RL, RL },
- { SNDRV_CHMAP_RR, RR },
- { SNDRV_CHMAP_LFE, LFE },
- { SNDRV_CHMAP_FC, FC },
- { SNDRV_CHMAP_RLC, RLC },
- { SNDRV_CHMAP_RRC, RRC },
- { SNDRV_CHMAP_RC, RC },
- { SNDRV_CHMAP_FLC, FLC },
- { SNDRV_CHMAP_FRC, FRC },
- {} /* terminator */
+};
In this case, the table can be put into snd_hdac_spk_to_chmap().
will be corrected in a v2
+/*
- cea Speaker allocation structure
- */
+struct hdmi_codec_cea_spk_alloc {
- int ca_index;
- int speakers[HDMI_MAX_SPEAKERS];
- /* Derived values, computed during init */
- int channels;
- int spk_mask;
- int spk_na_mask;
+};
+/*
- This is an ordered list!
- The preceding ones have better chances to be selected by
- hdmi_channel_allocation().
The function is not defined and implemented. It takes developers to be puzzled.
will be corrected in a v2
- */
+static struct hdmi_codec_cea_spk_alloc hdmi_codec_channel_alloc[] = { +/* channel: 7 6 5 4 3 2 1 0 */ +{ .ca_index = 0x00, .speakers = { 0, 0, 0, 0, 0, 0, FR, FL } },
/* 2.1 */
+{ .ca_index = 0x01, .speakers = { 0, 0, 0, 0, 0, LFE, FR, FL } },
/* Dolby Surround */
+{ .ca_index = 0x02, .speakers = { 0, 0, 0, 0, FC, 0, FR, FL } },
/* surround51 */
+{ .ca_index = 0x0b, .speakers = { 0, 0, RR, RL, FC, LFE, FR, FL } },
/* surround40 */
+{ .ca_index = 0x08, .speakers = { 0, 0, RR, RL, 0, 0, FR, FL } },
/* surround41 */
+{ .ca_index = 0x09, .speakers = { 0, 0, RR, RL, 0, LFE, FR, FL } },
/* surround50 */
+{ .ca_index = 0x0a, .speakers = { 0, 0, RR, RL, FC, 0, FR, FL } },
/* 6.1 */
+{ .ca_index = 0x0f, .speakers = { 0, RC, RR, RL, FC, LFE, FR, FL } },
/* surround71 */
+{ .ca_index = 0x13, .speakers = { RRC, RLC, RR, RL, FC, LFE, FR, FL } },
+{ .ca_index = 0x03, .speakers = { 0, 0, 0, 0, FC, LFE, FR, FL } }, +{ .ca_index = 0x04, .speakers = { 0, 0, 0, RC, 0, 0, FR, FL } }, +{ .ca_index = 0x05, .speakers = { 0, 0, 0, RC, 0, LFE, FR, FL } }, +{ .ca_index = 0x06, .speakers = { 0, 0, 0, RC, FC, 0, FR, FL } }, +{ .ca_index = 0x07, .speakers = { 0, 0, 0, RC, FC, LFE, FR, FL } }, +{ .ca_index = 0x0c, .speakers = { 0, RC, RR, RL, 0, 0, FR, FL } }, +{ .ca_index = 0x0d, .speakers = { 0, RC, RR, RL, 0, LFE, FR, FL } }, +{ .ca_index = 0x0e, .speakers = { 0, RC, RR, RL, FC, 0, FR, FL } }, +{ .ca_index = 0x10, .speakers = { RRC, RLC, RR, RL, 0, 0, FR, FL } }, +{ .ca_index = 0x11, .speakers = { RRC, RLC, RR, RL, 0, LFE, FR, FL } }, +{ .ca_index = 0x12, .speakers = { RRC, RLC, RR, RL, FC, 0, FR, FL } }, +{ .ca_index = 0x14, .speakers = { FRC, FLC, 0, 0, 0, 0, FR, FL } }, +{ .ca_index = 0x15, .speakers = { FRC, FLC, 0, 0, 0, LFE, FR, FL } }, +{ .ca_index = 0x16, .speakers = { FRC, FLC, 0, 0, FC, 0, FR, FL } }, +{ .ca_index = 0x17, .speakers = { FRC, FLC, 0, 0, FC, LFE, FR, FL } }, +{ .ca_index = 0x18, .speakers = { FRC, FLC, 0, RC, 0, 0, FR, FL } }, +{ .ca_index = 0x19, .speakers = { FRC, FLC, 0, RC, 0, LFE, FR, FL } }, +{ .ca_index = 0x1a, .speakers = { FRC, FLC, 0, RC, FC, 0, FR, FL } }, +{ .ca_index = 0x1b, .speakers = { FRC, FLC, 0, RC, FC, LFE, FR, FL } }, +{ .ca_index = 0x1c, .speakers = { FRC, FLC, RR, RL, 0, 0, FR, FL } }, +{ .ca_index = 0x1d, .speakers = { FRC, FLC, RR, RL, 0, LFE, FR, FL } }, +{ .ca_index = 0x1e, .speakers = { FRC, FLC, RR, RL, FC, 0, FR, FL } }, +{ .ca_index = 0x1f, .speakers = { FRC, FLC, RR, RL, FC, LFE, FR, FL } }, +};
Ditto.
Sorry not understand this comment vs the previous one, could you please clarify?
struct hdmi_codec_priv { struct hdmi_codec_pdata hcd; struct snd_soc_dai_driver *daidrv; @@ -32,6 +157,7 @@ struct hdmi_codec_priv { struct snd_pcm_substream *current_stream; struct snd_pcm_hw_constraint_list ratec; uint8_t eld[MAX_ELD_BYTES];
- unsigned int chmap[HDMI_MAX_SPEAKERS];
};
static const struct snd_soc_dapm_widget hdmi_widgets[] = { @@ -70,6 +196,201 @@ static int hdmi_eld_ctl_get(struct snd_kcontrol *kcontrol, return 0; }
+static int hdmi_codec_chmap_ctl_info(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_info *uinfo)
+{
- uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
- uinfo->count = HDMI_MAX_SPEAKERS;
- uinfo->value.integer.min = 0;
- uinfo->value.integer.max = SNDRV_CHMAP_LAST;
- return 0;
+}
+static int hdmi_codec_spk_mask_from_alloc(int spk_alloc) +{
- int i;
- int spk_mask = hdmi_codec_eld_spk_alloc_bits[0];
- for (i = 0; i < ARRAY_SIZE(hdmi_codec_eld_spk_alloc_bits); i++) {
if (spk_alloc & (1 << i))
spk_mask |= hdmi_codec_eld_spk_alloc_bits[i];
- }
- return spk_mask;
+}
+static int hdmi_codec_chmap_ctl_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
+{
- struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
- struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component);
- int i;
- memset(ucontrol->value.integer.value, 0,
sizeof(ucontrol->value.integer.value));
- mutex_lock(&hcp->current_stream_lock);
- if (hcp->current_stream)
for (i = 0; i < HDMI_MAX_SPEAKERS; i++)
ucontrol->value.integer.value[i] = hcp->chmap[i];
- mutex_unlock(&hcp->current_stream_lock);
- return 0;
+}
+/* From speaker bit mask to ALSA API channel position */ +static int snd_hdac_spk_to_chmap(int spk) +{
- struct hdmi_codec_channel_map_table *t = hdmi_codec_map_table;
- for (; t->map; t++) {
if (t->spk_mask == spk)
return t->map;
- }
- return 0;
+}
Why hdac? Are there some relationship between HDA controller and table you added?
No relation ship just a stupid guy who does a copy/past from hda without renaming...
+/**
- hdmi_codec_cea_init_channel_alloc:
- Compute derived values in hdmi_codec_channel_alloc[].
- spk_na_mask is used to store unused channels in mid of the channel
- allocations. These particular channels are then considered as active channels
- For instance:
- CA_ID 0x02: CA = (FL, FR, 0, FC) => spk_na_mask = 0x04, channels = 4
- CA_ID 0x04: CA = (FL, FR, 0, 0, RC) => spk_na_mask = 0x03C, channels = 5
- */
+static void hdmi_codec_cea_init_channel_alloc(void) +{
- int i, j, k, last;
- struct hdmi_codec_cea_spk_alloc *p;
- for (i = 0; i < ARRAY_SIZE(hdmi_codec_channel_alloc); i++) {
p = hdmi_codec_channel_alloc + i;
p->spk_mask = 0;
p->spk_na_mask = 0;
last = HDMI_MAX_SPEAKERS;
for (j = 0, k = 7; j < HDMI_MAX_SPEAKERS; j++, k--) {
if (p->speakers[j]) {
p->spk_mask |= p->speakers[j];
if (last == HDMI_MAX_SPEAKERS)
last = j;
} else if (last != HDMI_MAX_SPEAKERS) {
p->spk_na_mask |= 1 << k;
}
}
p->channels = 8 - last;
- }
+}
+static int hdmi_codec_get_ch_alloc_table_idx(struct hdmi_codec_priv *hcp,
unsigned char channels)
+{
- int i, spk_alloc, spk_mask;
- struct hdmi_codec_cea_spk_alloc *cap = hdmi_codec_channel_alloc;
- spk_alloc = drm_eld_get_spk_alloc(hcp->eld);
- spk_mask = hdmi_codec_spk_mask_from_alloc(spk_alloc);
- for (i = 0; i < ARRAY_SIZE(hdmi_codec_channel_alloc); i++, cap++) {
if (cap->channels != channels)
continue;
if (!(cap->spk_mask == (spk_mask & cap->spk_mask)))
continue;
return i;
- }
- return -EINVAL;
+}
+static void hdmi_cea_alloc_to_tlv_chmap(struct hdmi_codec_cea_spk_alloc *cap,
unsigned int *chmap)
+{
- int count = 0;
- int c, spk;
- /* Detect unused channels in cea caps, tag them as N/A channel in TLV */
- for (c = 0; c < HDMI_MAX_SPEAKERS; c++) {
spk = cap->speakers[7 - c];
if (cap->spk_na_mask & BIT(c))
chmap[count++] = SNDRV_CHMAP_NA;
else
chmap[count++] = snd_hdac_spk_to_chmap(spk);
- }
+}
+static int hdmi_codec_chmap_ctl_tlv(struct snd_kcontrol *kcontrol, int op_flag,
unsigned int size, unsigned int __user *tlv)
+{
- struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
- struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component);
- unsigned int __user *dst;
- int chs, count = 0;
- int num_ca = ARRAY_SIZE(hdmi_codec_channel_alloc);
- unsigned long max_chs;
- int spk_alloc, spk_mask;
- if (size < 8)
return -ENOMEM;
- if (put_user(SNDRV_CTL_TLVT_CONTAINER, tlv))
return -EFAULT;
- size -= 8;
- dst = tlv + 2;
- spk_alloc = drm_eld_get_spk_alloc(hcp->eld);
- spk_mask = hdmi_codec_spk_mask_from_alloc(spk_alloc);
- max_chs = hweight_long(spk_mask);
- for (chs = 2; chs <= max_chs; chs++) {
int i;
struct hdmi_codec_cea_spk_alloc *cap;
cap = hdmi_codec_channel_alloc;
for (i = 0; i < num_ca; i++, cap++) {
int chs_bytes = chs * 4;
unsigned int tlv_chmap[HDMI_MAX_SPEAKERS];
if (cap->channels != chs)
continue;
if (!(cap->spk_mask == (spk_mask & cap->spk_mask)))
continue;
Seems missing check here, related question below, in answer to your comment if (size < 8) return -ENOMEM;
/*
* Channel mapping is fixed as hdmi codec capability
* is not know.
*/
if (put_user(SNDRV_CTL_TLVT_CHMAP_FIXED, dst) ||
put_user(chs_bytes, dst + 1))
return -EFAULT;
dst += 2;
size -= 8;
count += 8;
if (size < chs_bytes)
return -ENOMEM;
size -= chs_bytes;
count += chs_bytes;
hdmi_cea_alloc_to_tlv_chmap(cap, tlv_chmap);
if (copy_to_user(dst, tlv_chmap, chs_bytes))
return -EFAULT;
dst += chs;
}
- }
- if (put_user(count, tlv + 1))
return -EFAULT;
- return 0;
+}
This function has a bug to cause buffer-over-run in user space because applications can request with a small buffer.
"size" is used for this, the bug is that a check is missing (the one i added in comment above), or i missed something else?
static const struct snd_kcontrol_new hdmi_controls[] = { { .access = SNDRV_CTL_ELEM_ACCESS_READ | @@ -79,6 +400,17 @@ static const struct snd_kcontrol_new hdmi_controls[] = { .info = hdmi_eld_ctl_info, .get = hdmi_eld_ctl_get, },
- {
.access = SNDRV_CTL_ELEM_ACCESS_READ |
SNDRV_CTL_ELEM_ACCESS_TLV_READ |
SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK |
SNDRV_CTL_ELEM_ACCESS_VOLATILE,
.iface = SNDRV_CTL_ELEM_IFACE_PCM,
.name = "Playback Channel Map",
.info = hdmi_codec_chmap_ctl_info,
.get = hdmi_codec_chmap_ctl_get,
.tlv.c = hdmi_codec_chmap_ctl_tlv,
- },
};
If you can keep the same interface for applications as 'snd_pcm_add_chmap_ctls()' have, it's better to integrate the function to have different tables/callbacks depending on drivers.
I had a look before define it. Unfortunately i cannot use snd_pcm_add_chmap_ctls. snd_pcm_add_chmap_ctls requests "snd_pcm" structure as input param. ASoC codec not aware of it. i could add an helper for ASoC, but hdmi-codec should be used for HDMI drivers and i'm not sure that there is another need in ASoC.
Thanks and Regards
Arnaud