mirror of https://github.com/hak5/openwrt.git
422 lines
14 KiB
Diff
422 lines
14 KiB
Diff
From 55349969a1914b515956c14f3fafd25df5c827a9 Mon Sep 17 00:00:00 2001
|
|
From: wm4 <wm4@nowhere>
|
|
Date: Wed, 13 Jan 2016 19:43:12 +0100
|
|
Subject: [PATCH] bcm2835: implement channel map API
|
|
|
|
Report all layouts supported by the HDMI protocol to userspace.
|
|
Make the videocore set the correct layout according to the
|
|
userspace request.
|
|
|
|
Some code taken from patch_hdmi.c. In particular, the HDMI channel
|
|
layout table was copied without changes - with the idea in mind that
|
|
hopefully it can be shared one day. Or at least updating it will be
|
|
simpler.
|
|
|
|
In my tests, everything appears to work, except when outputting
|
|
FL FR RL RR. Then my receiver outputs RL on both the RL and RR
|
|
speakers, while RR is never heard.
|
|
---
|
|
sound/arm/bcm2835-ctl.c | 276 ++++++++++++++++++++++++++++++++++++++++++++++
|
|
sound/arm/bcm2835-pcm.c | 22 +++-
|
|
sound/arm/bcm2835-vchiq.c | 13 +++
|
|
sound/arm/bcm2835.h | 4 +
|
|
4 files changed, 311 insertions(+), 4 deletions(-)
|
|
|
|
--- a/sound/arm/bcm2835-ctl.c
|
|
+++ b/sound/arm/bcm2835-ctl.c
|
|
@@ -300,6 +300,281 @@ static struct snd_kcontrol_new snd_bcm28
|
|
},
|
|
};
|
|
|
|
+struct cea_channel_speaker_allocation {
|
|
+ int ca_index;
|
|
+ int speakers[8];
|
|
+};
|
|
+
|
|
+#define FL SNDRV_CHMAP_FL
|
|
+#define FR SNDRV_CHMAP_FR
|
|
+#define RL SNDRV_CHMAP_RL
|
|
+#define RR SNDRV_CHMAP_RR
|
|
+#define LFE SNDRV_CHMAP_LFE
|
|
+#define FC SNDRV_CHMAP_FC
|
|
+#define RLC SNDRV_CHMAP_RLC
|
|
+#define RRC SNDRV_CHMAP_RRC
|
|
+#define RC SNDRV_CHMAP_RC
|
|
+#define FLC SNDRV_CHMAP_FLC
|
|
+#define FRC SNDRV_CHMAP_FRC
|
|
+#define FLH SNDRV_CHMAP_TFL
|
|
+#define FRH SNDRV_CHMAP_TFR
|
|
+#define FLW SNDRV_CHMAP_FLW
|
|
+#define FRW SNDRV_CHMAP_FRW
|
|
+#define TC SNDRV_CHMAP_TC
|
|
+#define FCH SNDRV_CHMAP_TFC
|
|
+
|
|
+/*
|
|
+ * CEA-861 channel maps
|
|
+ *
|
|
+ * Stolen from sound/pci/hda/patch_hdmi.c
|
|
+ * (unlike the source, this uses SNDRV_* constants directly, as by the
|
|
+ * map_tables array in patch_hdmi.c)
|
|
+ * Unknown entries use 0, which unfortunately is SNDRV_CHMAP_UNKNOWN instead
|
|
+ * of SNDRV_CHMAP_NA.
|
|
+ */
|
|
+static struct cea_channel_speaker_allocation channel_allocations[] = {
|
|
+/* 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 } },
|
|
+ /* 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 } },
|
|
+ /* surround51 */
|
|
+{ .ca_index = 0x0b, .speakers = { 0, 0, RR, RL, FC, LFE, 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 } },
|
|
+{ .ca_index = 0x20, .speakers = { 0, FCH, RR, RL, FC, 0, FR, FL } },
|
|
+{ .ca_index = 0x21, .speakers = { 0, FCH, RR, RL, FC, LFE, FR, FL } },
|
|
+{ .ca_index = 0x22, .speakers = { TC, 0, RR, RL, FC, 0, FR, FL } },
|
|
+{ .ca_index = 0x23, .speakers = { TC, 0, RR, RL, FC, LFE, FR, FL } },
|
|
+{ .ca_index = 0x24, .speakers = { FRH, FLH, RR, RL, 0, 0, FR, FL } },
|
|
+{ .ca_index = 0x25, .speakers = { FRH, FLH, RR, RL, 0, LFE, FR, FL } },
|
|
+{ .ca_index = 0x26, .speakers = { FRW, FLW, RR, RL, 0, 0, FR, FL } },
|
|
+{ .ca_index = 0x27, .speakers = { FRW, FLW, RR, RL, 0, LFE, FR, FL } },
|
|
+{ .ca_index = 0x28, .speakers = { TC, RC, RR, RL, FC, 0, FR, FL } },
|
|
+{ .ca_index = 0x29, .speakers = { TC, RC, RR, RL, FC, LFE, FR, FL } },
|
|
+{ .ca_index = 0x2a, .speakers = { FCH, RC, RR, RL, FC, 0, FR, FL } },
|
|
+{ .ca_index = 0x2b, .speakers = { FCH, RC, RR, RL, FC, LFE, FR, FL } },
|
|
+{ .ca_index = 0x2c, .speakers = { TC, FCH, RR, RL, FC, 0, FR, FL } },
|
|
+{ .ca_index = 0x2d, .speakers = { TC, FCH, RR, RL, FC, LFE, FR, FL } },
|
|
+{ .ca_index = 0x2e, .speakers = { FRH, FLH, RR, RL, FC, 0, FR, FL } },
|
|
+{ .ca_index = 0x2f, .speakers = { FRH, FLH, RR, RL, FC, LFE, FR, FL } },
|
|
+{ .ca_index = 0x30, .speakers = { FRW, FLW, RR, RL, FC, 0, FR, FL } },
|
|
+{ .ca_index = 0x31, .speakers = { FRW, FLW, RR, RL, FC, LFE, FR, FL } },
|
|
+};
|
|
+
|
|
+static int snd_bcm2835_chmap_ctl_tlv(struct snd_kcontrol *kcontrol, int op_flag,
|
|
+ unsigned int size, unsigned int __user *tlv)
|
|
+{
|
|
+ unsigned int __user *dst;
|
|
+ int count = 0;
|
|
+ int i;
|
|
+
|
|
+ if (size < 8)
|
|
+ return -ENOMEM;
|
|
+ if (put_user(SNDRV_CTL_TLVT_CONTAINER, tlv))
|
|
+ return -EFAULT;
|
|
+ size -= 8;
|
|
+ dst = tlv + 2;
|
|
+ for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
|
|
+ struct cea_channel_speaker_allocation *ch = &channel_allocations[i];
|
|
+ int num_chs = 0;
|
|
+ int chs_bytes;
|
|
+ int c;
|
|
+
|
|
+ for (c = 0; c < 8; c++) {
|
|
+ if (ch->speakers[c])
|
|
+ num_chs++;
|
|
+ }
|
|
+
|
|
+ chs_bytes = num_chs * 4;
|
|
+ if (size < 8)
|
|
+ return -ENOMEM;
|
|
+ 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;
|
|
+ for (c = 0; c < 8; c++) {
|
|
+ int sp = ch->speakers[7 - c];
|
|
+ if (sp) {
|
|
+ if (put_user(sp, dst))
|
|
+ return -EFAULT;
|
|
+ dst++;
|
|
+ }
|
|
+ }
|
|
+ }
|
|
+ if (put_user(count, tlv + 1))
|
|
+ return -EFAULT;
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int snd_bcm2835_chmap_ctl_get(struct snd_kcontrol *kcontrol,
|
|
+ struct snd_ctl_elem_value *ucontrol)
|
|
+{
|
|
+ struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
|
|
+ bcm2835_chip_t *chip = info->private_data;
|
|
+ unsigned int idx = snd_ctl_get_ioffidx(kcontrol, &ucontrol->id);
|
|
+ struct snd_pcm_substream *substream = snd_pcm_chmap_substream(info, idx);
|
|
+ struct cea_channel_speaker_allocation *ch = NULL;
|
|
+ int cur = 0;
|
|
+ int i;
|
|
+
|
|
+ if (!substream || !substream->runtime)
|
|
+ return -ENODEV;
|
|
+
|
|
+ for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
|
|
+ if (channel_allocations[i].ca_index == chip->cea_chmap)
|
|
+ ch = &channel_allocations[i];
|
|
+ }
|
|
+
|
|
+ /* If no layout was set yet, return a dummy. Apparently the userspace
|
|
+ * API will be confused if we don't. */
|
|
+ if (!ch)
|
|
+ ch = &channel_allocations[0];
|
|
+
|
|
+ for (i = 0; i < 8; i++) {
|
|
+ if (ch->speakers[7 - i])
|
|
+ ucontrol->value.integer.value[cur++] = ch->speakers[7 - i];
|
|
+ }
|
|
+ while (cur < 8)
|
|
+ ucontrol->value.integer.value[cur++] = SNDRV_CHMAP_NA;
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int snd_bcm2835_chmap_ctl_put(struct snd_kcontrol *kcontrol,
|
|
+ struct snd_ctl_elem_value *ucontrol)
|
|
+{
|
|
+ struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
|
|
+ bcm2835_chip_t *chip = info->private_data;
|
|
+ unsigned int idx = snd_ctl_get_ioffidx(kcontrol, &ucontrol->id);
|
|
+ struct snd_pcm_substream *substream = snd_pcm_chmap_substream(info, idx);
|
|
+ int i, prepared = 0, cea_chmap = -1;
|
|
+ int remap[8];
|
|
+
|
|
+ if (!substream || !substream->runtime)
|
|
+ return -ENODEV;
|
|
+
|
|
+ switch (substream->runtime->status->state) {
|
|
+ case SNDRV_PCM_STATE_OPEN:
|
|
+ case SNDRV_PCM_STATE_SETUP:
|
|
+ break;
|
|
+ case SNDRV_PCM_STATE_PREPARED:
|
|
+ prepared = 1;
|
|
+ break;
|
|
+ default:
|
|
+ return -EBUSY;
|
|
+ }
|
|
+
|
|
+ for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
|
|
+ struct cea_channel_speaker_allocation *ch = &channel_allocations[i];
|
|
+ int matches = 1;
|
|
+ int cur = 0;
|
|
+ int x;
|
|
+ memset(remap, 0, sizeof(remap));
|
|
+ for (x = 0; x < substream->runtime->channels; x++) {
|
|
+ int sp = ucontrol->value.integer.value[x];
|
|
+ while (cur < 8 && !ch->speakers[7 - cur])
|
|
+ cur++;
|
|
+ if (cur >= 8) {
|
|
+ /* user has more channels than ch */
|
|
+ matches = 0;
|
|
+ break;
|
|
+ }
|
|
+ if (ch->speakers[7 - cur] != sp) {
|
|
+ matches = 0;
|
|
+ break;
|
|
+ }
|
|
+ remap[x] = cur;
|
|
+ cur++;
|
|
+ }
|
|
+ for (x = cur; x < 8; x++) {
|
|
+ if (ch->speakers[7 - x]) {
|
|
+ /* ch has more channels than user */
|
|
+ matches = 0;
|
|
+ break;
|
|
+ }
|
|
+ }
|
|
+ if (matches) {
|
|
+ cea_chmap = ch->ca_index;
|
|
+ break;
|
|
+ }
|
|
+ }
|
|
+
|
|
+ if (cea_chmap < 0)
|
|
+ return -EINVAL;
|
|
+
|
|
+ /* don't change the layout if another substream is active */
|
|
+ if (chip->opened != (1 << substream->number) && chip->cea_chmap != cea_chmap)
|
|
+ return -EBUSY; /* unsure whether this is a good error code */
|
|
+
|
|
+ chip->cea_chmap = cea_chmap;
|
|
+ for (i = 0; i < 8; i++)
|
|
+ chip->map_channels[i] = remap[i];
|
|
+ if (prepared)
|
|
+ snd_bcm2835_pcm_prepare_again(substream);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int snd_bcm2835_add_chmap_ctl(bcm2835_chip_t * chip)
|
|
+{
|
|
+ struct snd_pcm_chmap *chmap;
|
|
+ struct snd_kcontrol *kctl;
|
|
+ int err, i;
|
|
+
|
|
+ err = snd_pcm_add_chmap_ctls(chip->pcm,
|
|
+ SNDRV_PCM_STREAM_PLAYBACK,
|
|
+ NULL, 8, 0, &chmap);
|
|
+ if (err < 0)
|
|
+ return err;
|
|
+ /* override handlers */
|
|
+ chmap->private_data = chip;
|
|
+ kctl = chmap->kctl;
|
|
+ for (i = 0; i < kctl->count; i++)
|
|
+ kctl->vd[i].access |= SNDRV_CTL_ELEM_ACCESS_WRITE;
|
|
+ kctl->get = snd_bcm2835_chmap_ctl_get;
|
|
+ kctl->put = snd_bcm2835_chmap_ctl_put;
|
|
+ kctl->tlv.c = snd_bcm2835_chmap_ctl_tlv;
|
|
+ return 0;
|
|
+}
|
|
+
|
|
int snd_bcm2835_new_ctl(bcm2835_chip_t * chip)
|
|
{
|
|
int err;
|
|
@@ -313,6 +588,7 @@ int snd_bcm2835_new_ctl(bcm2835_chip_t *
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
+ snd_bcm2835_add_chmap_ctl(chip);
|
|
for (idx = 0; idx < ARRAY_SIZE(snd_bcm2835_spdif); idx++) {
|
|
err = snd_ctl_add(chip->card,
|
|
snd_ctl_new1(&snd_bcm2835_spdif[idx], chip));
|
|
--- a/sound/arm/bcm2835-pcm.c
|
|
+++ b/sound/arm/bcm2835-pcm.c
|
|
@@ -231,6 +231,9 @@ static int snd_bcm2835_playback_open_gen
|
|
|
|
chip->alsa_stream[idx] = alsa_stream;
|
|
|
|
+ if (!chip->opened)
|
|
+ chip->cea_chmap = -1;
|
|
+
|
|
chip->opened |= (1 << idx);
|
|
alsa_stream->open = 1;
|
|
alsa_stream->draining = 1;
|
|
@@ -341,8 +344,7 @@ static int snd_bcm2835_pcm_hw_free(struc
|
|
return snd_pcm_lib_free_pages(substream);
|
|
}
|
|
|
|
-/* prepare callback */
|
|
-static int snd_bcm2835_pcm_prepare(struct snd_pcm_substream *substream)
|
|
+int snd_bcm2835_pcm_prepare_again(struct snd_pcm_substream *substream)
|
|
{
|
|
bcm2835_chip_t *chip = snd_pcm_substream_chip(substream);
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
@@ -350,8 +352,6 @@ static int snd_bcm2835_pcm_prepare(struc
|
|
int channels;
|
|
int err;
|
|
|
|
- audio_info(" .. IN\n");
|
|
-
|
|
/* notify the vchiq that it should enter spdif passthrough mode by
|
|
* setting channels=0 (see
|
|
* https://github.com/raspberrypi/linux/issues/528) */
|
|
@@ -367,6 +367,20 @@ static int snd_bcm2835_pcm_prepare(struc
|
|
audio_error(" error setting hw params\n");
|
|
}
|
|
|
|
+ return err;
|
|
+}
|
|
+
|
|
+/* prepare callback */
|
|
+static int snd_bcm2835_pcm_prepare(struct snd_pcm_substream *substream)
|
|
+{
|
|
+ bcm2835_chip_t *chip = snd_pcm_substream_chip(substream);
|
|
+ struct snd_pcm_runtime *runtime = substream->runtime;
|
|
+ bcm2835_alsa_stream_t *alsa_stream = runtime->private_data;
|
|
+
|
|
+ audio_info(" .. IN\n");
|
|
+
|
|
+ snd_bcm2835_pcm_prepare_again(substream);
|
|
+
|
|
bcm2835_audio_setup(alsa_stream);
|
|
|
|
/* in preparation of the stream, set the controls (volume level) of the stream */
|
|
--- a/sound/arm/bcm2835-vchiq.c
|
|
+++ b/sound/arm/bcm2835-vchiq.c
|
|
@@ -570,6 +570,8 @@ int bcm2835_audio_set_params(bcm2835_als
|
|
VC_AUDIO_MSG_T m;
|
|
AUDIO_INSTANCE_T *instance = alsa_stream->instance;
|
|
int32_t success;
|
|
+ uint32_t chmap_value;
|
|
+ int i;
|
|
int ret;
|
|
LOG_DBG(" .. IN\n");
|
|
|
|
@@ -593,10 +595,21 @@ int bcm2835_audio_set_params(bcm2835_als
|
|
|
|
instance->result = -1;
|
|
|
|
+ if (alsa_stream->chip->cea_chmap >= 0) {
|
|
+ chmap_value = (unsigned)alsa_stream->chip->cea_chmap << 24;
|
|
+ } else {
|
|
+ chmap_value = 0; /* force stereo */
|
|
+ for (i = 0; i < 8; i++)
|
|
+ alsa_stream->chip->map_channels[i] = i;
|
|
+ }
|
|
+ for (i = 0; i < 8; i++)
|
|
+ chmap_value |= alsa_stream->chip->map_channels[i] << (i * 3);
|
|
+
|
|
m.type = VC_AUDIO_MSG_TYPE_CONFIG;
|
|
m.u.config.channels = channels;
|
|
m.u.config.samplerate = samplerate;
|
|
m.u.config.bps = bps;
|
|
+ m.u.config.channelmap = chmap_value;
|
|
|
|
/* Create the message available completion */
|
|
init_completion(&instance->msg_avail_comp);
|
|
--- a/sound/arm/bcm2835.h
|
|
+++ b/sound/arm/bcm2835.h
|
|
@@ -107,6 +107,8 @@ typedef struct bcm2835_chip {
|
|
int old_volume; /* stores the volume value whist muted */
|
|
int dest;
|
|
int mute;
|
|
+ int cea_chmap; /* currently requested Audio InfoFrame Data Byte 4 */
|
|
+ int map_channels[8];
|
|
|
|
unsigned int opened;
|
|
unsigned int spdif_status;
|
|
@@ -149,6 +151,8 @@ int snd_bcm2835_new_ctl(bcm2835_chip_t *
|
|
int snd_bcm2835_new_pcm(bcm2835_chip_t * chip);
|
|
int snd_bcm2835_new_spdif_pcm(bcm2835_chip_t * chip);
|
|
|
|
+int snd_bcm2835_pcm_prepare_again(struct snd_pcm_substream *substream);
|
|
+
|
|
int bcm2835_audio_open(bcm2835_alsa_stream_t * alsa_stream);
|
|
int bcm2835_audio_close(bcm2835_alsa_stream_t * alsa_stream);
|
|
int bcm2835_audio_set_params(bcm2835_alsa_stream_t * alsa_stream,
|