--- /dev/null
+/*
+ * PCM - Surround plugin
+ * Copyright (c) 2001 by Jaroslav Kysela <perex@suse.cz>
+ *
+ * This plugin offers 4.0 and 5.1 surround devices with these routing:
+ *
+ * 1st channel - front left speaker
+ * 2nd channel - front rear speaker
+ * 3rd channel - rear left speaker
+ * 4th channel - rear right speaker
+ * 5th channel - center speaker
+ * 6th channel - LFE channel (woofer)
+ *
+ *
+ * This library is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU Library General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * This program 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 Library General Public License for more details.
+ *
+ * You should have received a copy of the GNU Library General Public
+ * License along with this library; if not, write to the Free Software
+ * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ *
+ */
+
+#include <byteswap.h>
+#include <limits.h>
+#include <sys/shm.h>
+#include "pcm_local.h"
+#include "pcm_plugin.h"
+
+typedef struct {
+ int card; /* card number */
+ int device; /* device number */
+ unsigned int channels; /* count of channels (4 or 6) */
+ int pcms; /* count of PCM channels */
+ snd_pcm_t *pcm[3]; /* up to three PCM stereo streams */
+} snd_pcm_surround_t;
+
+static int snd_pcm_surround_close(snd_pcm_t *pcm)
+{
+ int i;
+ snd_pcm_surround_t *surr = pcm->private_data;
+ for (i = 0; i < surr->pcms; i++)
+ snd_pcm_close(surr->pcm[i]);
+ free(surr);
+ return 0;
+}
+
+static int snd_pcm_surround_nonblock(snd_pcm_t *pcm, int nonblock)
+{
+ int i, err = 0, err1;
+ snd_pcm_surround_t *surr = pcm->private_data;
+ for (i = 0; i < surr->pcms; i++) {
+ err1 = snd_pcm_nonblock(surr->pcm[i], nonblock);
+ if (err1 && !err)
+ err = err1;
+ }
+ return err;
+}
+
+static int snd_pcm_surround_async(snd_pcm_t *pcm, int sig, pid_t pid)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_async(surr->pcm[0], sig, pid);
+}
+
+static int snd_pcm_surround_info(snd_pcm_t *pcm, snd_pcm_info_t * info)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ memset(info, 0, sizeof(*info));
+ info->stream = snd_enum_to_int(pcm->stream);
+ info->card = surr->card;
+ strncpy(info->id, "Surround", sizeof(info->id));
+ strncpy(info->name, "Surround", sizeof(info->name));
+ strncpy(info->subname, "Surround", sizeof(info->subname));
+ info->subdevices_count = 1;
+ return 0;
+}
+
+static int snd_pcm_surround_channel_info(snd_pcm_t *pcm, snd_pcm_channel_info_t * info)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ if (surr->pcms == 1 || info->channel == 0 || info->channel == 1)
+ return snd_pcm_channel_info(surr->pcm[0], info);
+ if (surr->pcms > 1 && (info->channel == 2 || info->channel == 3))
+ return snd_pcm_channel_info(surr->pcm[1], info);
+ if (surr->pcms > 2 && (info->channel == 3 || info->channel == 4))
+ return snd_pcm_channel_info(surr->pcm[2], info);
+ return -EINVAL;
+}
+
+static int snd_pcm_surround_status(snd_pcm_t *pcm, snd_pcm_status_t * status)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_status(surr->pcm[0], status);
+}
+
+static snd_pcm_state_t snd_pcm_surround_state(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_state(surr->pcm[0]);
+}
+
+static int snd_pcm_surround_delay(snd_pcm_t *pcm, snd_pcm_sframes_t *delayp)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_delay(surr->pcm[0], delayp);
+}
+
+static int snd_pcm_surround_prepare(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_prepare(surr->pcm[0]);
+}
+
+static int snd_pcm_surround_reset(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_reset(surr->pcm[0]);
+}
+
+static int snd_pcm_surround_start(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_start(surr->pcm[0]);
+}
+
+static int snd_pcm_surround_drop(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_drop(surr->pcm[0]);
+}
+
+static int snd_pcm_surround_drain(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_drain(surr->pcm[0]);
+}
+
+static int snd_pcm_surround_pause(snd_pcm_t *pcm, int enable)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_pause(surr->pcm[0], enable);
+}
+
+static snd_pcm_sframes_t snd_pcm_surround_rewind(snd_pcm_t *pcm, snd_pcm_uframes_t frames)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_rewind(surr->pcm[0], frames);
+}
+
+static snd_pcm_sframes_t snd_pcm_surround_writei(snd_pcm_t *pcm, const void *buffer, snd_pcm_uframes_t size)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ if (surr->pcms == 1)
+ return snd_pcm_writei(pcm, buffer, size);
+ /* TODO: convert interleaved stream to two or three stereo streams */
+ return -EIO;
+}
+
+static snd_pcm_sframes_t snd_pcm_surround_writen(snd_pcm_t *pcm, void **bufs, snd_pcm_uframes_t size)
+{
+ int i;
+ snd_pcm_sframes_t res = -1, res1;
+ snd_pcm_surround_t *surr = pcm->private_data;
+ for (i = 0; i < surr->pcms; i++) {
+ res1 = snd_pcm_writen(pcm, bufs, size);
+ if (res1 < 0)
+ return res1;
+ if (res < 0)
+ res = res1;
+ else if (res != res1)
+ return -EPIPE;
+ }
+ return res;
+}
+
+static snd_pcm_sframes_t snd_pcm_surround_readi(snd_pcm_t *pcm, void *buffer, snd_pcm_uframes_t size)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ if (surr->pcms == 1)
+ return snd_pcm_readi(pcm, buffer, size);
+ /* TODO: convert two or three stereo streams to one interleaved stream */
+ return -EIO;
+}
+
+static snd_pcm_sframes_t snd_pcm_surround_readn(snd_pcm_t *pcm, void **bufs, snd_pcm_uframes_t size)
+{
+ int i;
+ snd_pcm_sframes_t res = -1, res1;
+ snd_pcm_surround_t *surr = pcm->private_data;
+ for (i = 0; i < surr->pcms; i++) {
+ res1 = snd_pcm_writen(pcm, bufs, size);
+ if (res1 < 0)
+ return res1;
+ if (res < 0) {
+ res = size = res1;
+ } else if (res != res1)
+ return -EPIPE;
+ }
+ return res;
+}
+
+static snd_pcm_sframes_t snd_pcm_surround_mmap_forward(snd_pcm_t *pcm, snd_pcm_uframes_t size)
+{
+ int i;
+ snd_pcm_sframes_t res = -1, res1;
+ snd_pcm_surround_t *surr = pcm->private_data;
+ for (i = 0; i < surr->pcms; i++) {
+ res1 = snd_pcm_mmap_forward(surr->pcm[i], size);
+ if (res1 < 0)
+ return res1;
+ if (res < 0) {
+ res = size = res1;
+ } else if (res != res1)
+ return -EPIPE;
+ }
+ return res;
+}
+
+static snd_pcm_sframes_t snd_pcm_surround_avail_update(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return snd_pcm_avail_update(surr->pcm[0]);
+}
+
+static int snd_pcm_surround_interval_channels(snd_pcm_surround_t *surr,
+ snd_pcm_hw_params_t *params,
+ int refine)
+{
+ snd_interval_t *interval;
+ interval = ¶ms->intervals[SND_PCM_HW_PARAM_CHANNELS-SNDRV_PCM_HW_PARAM_FIRST_INTERVAL];
+ if (interval->empty)
+ return -EINVAL;
+ if (interval->openmin) {
+ if (!refine)
+ return -EINVAL;
+ interval->min = surr->channels;
+ interval->openmin = 0;
+ }
+ if (interval->openmax) {
+ if (!refine)
+ return -EINVAL;
+ interval->max = surr->channels;
+ interval->openmax = 0;
+ }
+ if (refine && interval->min <= surr->channels && interval->max >= surr->channels)
+ interval->min = interval->max = surr->channels;
+ if (interval->min != interval->max || interval->min != surr->channels)
+ return -EINVAL;
+ if (surr->pcms != 1)
+ interval->min = interval->max = 2;
+ return 0;
+}
+
+static int snd_pcm_surround_hw_refine(snd_pcm_t *pcm, snd_pcm_hw_params_t *params)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ int i, err = snd_pcm_surround_interval_channels(surr, params, 1);
+ if (err < 0)
+ return err;
+ if (surr->pcms == 1)
+ return snd_pcm_hw_refine(surr->pcm[0], params);
+ for (i = 0; i < surr->pcms; i++) {
+ err = snd_pcm_hw_refine(surr->pcm[i], params);
+ if (err < 0)
+ return err;
+ }
+ return 0;
+}
+
+static int snd_pcm_surround_hw_params(snd_pcm_t *pcm, snd_pcm_hw_params_t * params)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ int i, err = snd_pcm_surround_interval_channels(surr, params, 0);
+ if (err < 0)
+ return err;
+ if (surr->pcms == 1)
+ return snd_pcm_hw_params(surr->pcm[0], params);
+ for (i = 0; i < surr->pcms; i++) {
+ err = snd_pcm_hw_params(surr->pcm[i], params);
+ if (err < 0)
+ return err;
+ }
+ return 0;
+}
+
+static int snd_pcm_surround_hw_free(snd_pcm_t *pcm ATTRIBUTE_UNUSED)
+{
+ int i, err;
+ snd_pcm_surround_t *surr = pcm->private_data;
+ for (i = 0; i < surr->pcms; i++) {
+ err = snd_pcm_hw_free(surr->pcm[i]);
+ if (err < 0)
+ return err;
+ }
+ return 0;
+}
+
+static int snd_pcm_surround_sw_params(snd_pcm_t *pcm, snd_pcm_sw_params_t * params)
+{
+ int i, err;
+ snd_pcm_surround_t *surr = pcm->private_data;
+ for (i = 0; i < surr->pcms; i++) {
+ err = snd_pcm_sw_params(surr->pcm[i], params);
+ if (err < 0)
+ return err;
+ }
+ return 0;
+}
+
+static int snd_pcm_surround_mmap(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return 0;
+}
+
+static int snd_pcm_surround_munmap(snd_pcm_t *pcm)
+{
+ snd_pcm_surround_t *surr = pcm->private_data;
+ return 0;
+}
+
+static void snd_pcm_surround_dump(snd_pcm_t *pcm, snd_output_t *out)
+{
+ snd_output_printf(out, "Surround PCM\n");
+ if (pcm->setup) {
+ snd_output_printf(out, "Its setup is:\n");
+ snd_pcm_dump_setup(pcm, out);
+ }
+}
+
+snd_pcm_ops_t snd_pcm_surround_ops = {
+ close: snd_pcm_surround_close,
+ info: snd_pcm_surround_info,
+ hw_refine: snd_pcm_surround_hw_refine,
+ hw_params: snd_pcm_surround_hw_params,
+ hw_free: snd_pcm_surround_hw_free,
+ sw_params: snd_pcm_surround_sw_params,
+ channel_info: snd_pcm_surround_channel_info,
+ dump: snd_pcm_surround_dump,
+ nonblock: snd_pcm_surround_nonblock,
+ async: snd_pcm_surround_async,
+ mmap: snd_pcm_surround_mmap,
+ munmap: snd_pcm_surround_munmap,
+};
+
+snd_pcm_fast_ops_t snd_pcm_surround_fast_ops = {
+ status: snd_pcm_surround_status,
+ state: snd_pcm_surround_state,
+ delay: snd_pcm_surround_delay,
+ prepare: snd_pcm_surround_prepare,
+ reset: snd_pcm_surround_reset,
+ start: snd_pcm_surround_start,
+ drop: snd_pcm_surround_drop,
+ drain: snd_pcm_surround_drain,
+ pause: snd_pcm_surround_pause,
+ rewind: snd_pcm_surround_rewind,
+ writei: snd_pcm_surround_writei,
+ writen: snd_pcm_surround_writen,
+ readi: snd_pcm_surround_readi,
+ readn: snd_pcm_surround_readn,
+ avail_update: snd_pcm_surround_avail_update,
+ mmap_forward: snd_pcm_surround_mmap_forward,
+};
+
+int snd_pcm_surround_open(snd_pcm_t **pcmp, const char *name, int card, int dev,
+ snd_pcm_surround_type_t type,
+ snd_pcm_stream_t stream, int mode)
+{
+ snd_pcm_t *pcm;
+ snd_pcm_surround_t *surr;
+ assert(pcmp);
+ if (stream == SND_PCM_STREAM_CAPTURE)
+ return -EINVAL; /* not supported at the time */
+ surr = calloc(1, sizeof(snd_pcm_surround_t));
+ if (!surr) {
+ return -ENOMEM;
+ }
+
+ pcm = calloc(1, sizeof(snd_pcm_t));
+ if (!pcm) {
+ free(surr);
+ return -ENOMEM;
+ }
+ if (name)
+ pcm->name = strdup(name);
+ pcm->type = SND_PCM_TYPE_SURROUND;
+ pcm->stream = stream;
+ pcm->mode = mode;
+ pcm->ops = &snd_pcm_surround_ops;
+ pcm->op_arg = pcm;
+ pcm->fast_ops = &snd_pcm_surround_fast_ops;
+ pcm->fast_op_arg = pcm;
+ pcm->private_data = surr;
+ pcm->poll_fd = -1; /* FIXME */
+ pcm->hw_ptr = NULL; /* FIXME */
+ pcm->appl_ptr = NULL; /* FIXME */
+ *pcmp = pcm;
+
+ return 0;
+}
+
+int _snd_pcm_surround_open(snd_pcm_t **pcmp, const char *name, snd_config_t *conf,
+ snd_pcm_stream_t stream, int mode)
+{
+ snd_config_iterator_t i, next;
+ long card = -1, device = 0;
+ const char *str;
+ int err;
+ snd_pcm_surround_type_t type = SND_PCM_SURROUND_40;
+ snd_config_for_each(i, next, conf) {
+ snd_config_t *n = snd_config_iterator_entry(i);
+ const char *id = snd_config_get_id(n);
+ if (strcmp(id, "comment") == 0)
+ continue;
+ if (strcmp(id, "type") == 0)
+ continue;
+ if (strcmp(id, "card") == 0) {
+ err = snd_config_get_integer(n, &card);
+ if (err < 0) {
+ err = snd_config_get_string(n, &str);
+ if (err < 0) {
+ SNDERR("Invalid type for %s", id);
+ return -EINVAL;
+ }
+ card = snd_card_get_index(str);
+ if (card < 0) {
+ SNDERR("Invalid value for %s", id);
+ return card;
+ }
+ }
+ continue;
+ }
+ if (strcmp(id, "device") == 0) {
+ err = snd_config_get_integer(n, &device);
+ if (err < 0) {
+ SNDERR("Invalid type for %s", id);
+ return err;
+ }
+ continue;
+ }
+#if 0
+ if (strcmp(id, "subdevice") == 0) {
+ err = snd_config_get_integer(n, &subdevice);
+ if (err < 0) {
+ SNDERR("Invalid type for %s", id);
+ return err;
+ }
+ continue;
+ }
+#endif
+ if (strcmp(id, "type") == 0) {
+ err = snd_config_get_string(n, &str);
+ if (strcmp(str, "40") == 0 || strcmp(str, "4.0") == 0)
+ type = SND_PCM_SURROUND_40;
+ else if (strcmp(str, "51") == 0 || strcmp(str, "5.1") == 0)
+ type = SND_PCM_SURROUND_51;
+ }
+ SNDERR("Unknown field %s", id);
+ return -EINVAL;
+ }
+ if (card < 0) {
+ SNDERR("card is not defined");
+ return -EINVAL;
+ }
+ return snd_pcm_surround_open(pcmp, name, card, device, type, stream, mode);
+}