mirror of
https://github.com/alsa-project/alsa-lib.git
synced 2025-11-02 09:01:48 -05:00
748 lines
19 KiB
C
748 lines
19 KiB
C
/*
|
|
* PCM Plug-In Interface
|
|
* Copyright (c) 1999 by Jaroslav Kysela <perex@suse.cz>
|
|
*
|
|
*
|
|
* 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 <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <math.h>
|
|
#include "pcm_local.h"
|
|
|
|
snd_pcm_plugin_t *snd_pcm_plugin_build(const char *name, int extra)
|
|
{
|
|
snd_pcm_plugin_t *plugin;
|
|
|
|
if (extra < 0)
|
|
return NULL;
|
|
plugin = (snd_pcm_plugin_t *)calloc(1, sizeof(*plugin) + extra);
|
|
if (plugin == NULL)
|
|
return NULL;
|
|
plugin->name = name ? strdup(name) : NULL;
|
|
return plugin;
|
|
}
|
|
|
|
int snd_pcm_plugin_free(snd_pcm_plugin_t *plugin)
|
|
{
|
|
if (plugin) {
|
|
if (plugin->private_free)
|
|
plugin->private_free(plugin, plugin->private_data);
|
|
if (plugin->name)
|
|
free(plugin->name);
|
|
free(plugin);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int snd_pcm_plugin_clear(snd_pcm_t *pcm, int channel)
|
|
{
|
|
snd_pcm_plugin_t *plugin, *plugin_next;
|
|
int idx;
|
|
|
|
if (!pcm)
|
|
return -EINVAL;
|
|
plugin = pcm->plugin_first[channel];
|
|
pcm->plugin_first[channel] = NULL;
|
|
pcm->plugin_last[channel] = NULL;
|
|
while (plugin) {
|
|
plugin_next = plugin->next;
|
|
snd_pcm_plugin_free(plugin);
|
|
plugin = plugin_next;
|
|
}
|
|
for (idx = 0; idx < 4; idx++) {
|
|
if (pcm->plugin_alloc_ptr[idx])
|
|
free(pcm->plugin_alloc_ptr[idx]);
|
|
pcm->plugin_alloc_ptr[idx] = 0;
|
|
pcm->plugin_alloc_size[idx] = 0;
|
|
pcm->plugin_alloc_lock[idx] = 0;
|
|
}
|
|
if (pcm->plugin_alloc_xptr[channel])
|
|
free(pcm->plugin_alloc_xptr[channel]);
|
|
pcm->plugin_alloc_xptr[channel] = NULL;
|
|
pcm->plugin_alloc_xsize[channel] = 0;
|
|
return 0;
|
|
}
|
|
|
|
int snd_pcm_plugin_insert(snd_pcm_t *pcm, int channel, snd_pcm_plugin_t *plugin)
|
|
{
|
|
if (!pcm || channel < 0 || channel > 1 || !plugin)
|
|
return -EINVAL;
|
|
plugin->next = pcm->plugin_first[channel];
|
|
plugin->prev = NULL;
|
|
if (pcm->plugin_first[channel]) {
|
|
pcm->plugin_first[channel]->prev = plugin;
|
|
pcm->plugin_first[channel] = plugin;
|
|
} else {
|
|
pcm->plugin_last[channel] =
|
|
pcm->plugin_first[channel] = plugin;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int snd_pcm_plugin_remove_to(snd_pcm_t *pcm, int channel, snd_pcm_plugin_t *plugin)
|
|
{
|
|
snd_pcm_plugin_t *plugin1, *plugin1_prev;
|
|
|
|
if (!pcm || channel < 0 || channel > 1 || !plugin || !plugin->prev)
|
|
return -EINVAL;
|
|
plugin1 = plugin;
|
|
while (plugin1->prev)
|
|
plugin1 = plugin1->prev;
|
|
if (pcm->plugin_first[channel] != plugin1)
|
|
return -EINVAL;
|
|
pcm->plugin_first[channel] = plugin;
|
|
plugin1 = plugin->prev;
|
|
plugin->prev = NULL;
|
|
while (plugin1) {
|
|
plugin1_prev = plugin1->prev;
|
|
snd_pcm_plugin_free(plugin1);
|
|
plugin1 = plugin1_prev;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int snd_pcm_plugin_remove_first(snd_pcm_t *pcm, int channel)
|
|
{
|
|
snd_pcm_plugin_t *plugin;
|
|
|
|
plugin = snd_pcm_plugin_first(pcm, channel);
|
|
if (plugin->next) {
|
|
plugin = plugin->next;
|
|
} else {
|
|
return snd_pcm_plugin_clear(pcm, channel);
|
|
}
|
|
return snd_pcm_plugin_remove_to(pcm, channel, plugin);
|
|
}
|
|
|
|
snd_pcm_plugin_t *snd_pcm_plugin_first(snd_pcm_t *pcm, int channel)
|
|
{
|
|
if (!pcm || channel < 0 || channel > 1)
|
|
return NULL;
|
|
return pcm->plugin_first[channel];
|
|
}
|
|
|
|
snd_pcm_plugin_t *snd_pcm_plugin_last(snd_pcm_t *pcm, int channel)
|
|
{
|
|
if (!pcm || channel < 0 || channel > 1)
|
|
return NULL;
|
|
return pcm->plugin_last[channel];
|
|
}
|
|
|
|
ssize_t snd_pcm_plugin_transfer_size(snd_pcm_t *pcm, int channel, size_t drv_size)
|
|
{
|
|
snd_pcm_plugin_t *plugin, *plugin_prev, *plugin_next;
|
|
|
|
if (!pcm || channel < 0 || channel > 1)
|
|
return -EINVAL;
|
|
if (drv_size == 0)
|
|
return 0;
|
|
if (drv_size < 0)
|
|
return -EINVAL;
|
|
if (channel == SND_PCM_CHANNEL_PLAYBACK) {
|
|
plugin = snd_pcm_plugin_last(pcm, channel);
|
|
while (plugin) {
|
|
plugin_prev = plugin->prev;
|
|
if (plugin->src_size)
|
|
drv_size = plugin->src_size(plugin, drv_size);
|
|
plugin = plugin_prev;
|
|
}
|
|
} else if (channel == SND_PCM_CHANNEL_CAPTURE) {
|
|
plugin = snd_pcm_plugin_first(pcm, channel);
|
|
while (plugin) {
|
|
plugin_next = plugin->next;
|
|
if (plugin->dst_size)
|
|
drv_size = plugin->dst_size(plugin, drv_size);
|
|
plugin = plugin_next;
|
|
}
|
|
}
|
|
return drv_size;
|
|
}
|
|
|
|
ssize_t snd_pcm_plugin_hardware_size(snd_pcm_t *pcm, int channel, size_t trf_size)
|
|
{
|
|
snd_pcm_plugin_t *plugin, *plugin_prev, *plugin_next;
|
|
|
|
if (!pcm || channel < 0 || channel > 1)
|
|
return -EINVAL;
|
|
if (trf_size == 0)
|
|
return 0;
|
|
if (trf_size < 0)
|
|
return -EINVAL;
|
|
if (channel == SND_PCM_CHANNEL_PLAYBACK) {
|
|
plugin = snd_pcm_plugin_first(pcm, channel);
|
|
while (plugin) {
|
|
plugin_next = plugin->next;
|
|
if (plugin->dst_size)
|
|
trf_size = plugin->dst_size(plugin, trf_size);
|
|
plugin = plugin_next;
|
|
}
|
|
} else if (channel == SND_PCM_CHANNEL_CAPTURE) {
|
|
plugin = snd_pcm_plugin_last(pcm, channel);
|
|
while (plugin) {
|
|
plugin_prev = plugin->prev;
|
|
if (plugin->src_size)
|
|
trf_size = plugin->src_size(plugin, trf_size);
|
|
plugin = plugin_prev;
|
|
}
|
|
}
|
|
return trf_size;
|
|
}
|
|
|
|
double snd_pcm_plugin_transfer_ratio(snd_pcm_t *pcm, int channel)
|
|
{
|
|
ssize_t transfer;
|
|
|
|
transfer = snd_pcm_plugin_transfer_size(pcm, channel, 100000);
|
|
if (transfer < 0)
|
|
return 0;
|
|
return (double)transfer / (double)100000;
|
|
}
|
|
|
|
double snd_pcm_plugin_hardware_ratio(snd_pcm_t *pcm, int channel)
|
|
{
|
|
ssize_t hardware;
|
|
|
|
hardware = snd_pcm_plugin_hardware_size(pcm, channel, 100000);
|
|
if (hardware < 0)
|
|
return 0;
|
|
return (double)hardware / (double)100000;
|
|
}
|
|
|
|
/*
|
|
*
|
|
*/
|
|
|
|
static unsigned int snd_pcm_plugin_formats(snd_pcm_t *pcm, unsigned int formats)
|
|
{
|
|
formats |= SND_PCM_FMT_MU_LAW;
|
|
if (formats & (SND_PCM_SFMT_U8|SND_PCM_SFMT_S8|
|
|
SND_PCM_SFMT_U16_LE|SND_PCM_SFMT_S16_LE))
|
|
formats |= SND_PCM_SFMT_U8|SND_PCM_SFMT_S8|
|
|
SND_PCM_SFMT_U16_LE|SND_PCM_SFMT_S16_LE;
|
|
return formats;
|
|
}
|
|
|
|
int snd_pcm_plugin_info(snd_pcm_t *pcm, snd_pcm_channel_info_t *info)
|
|
{
|
|
int err;
|
|
|
|
if ((err = snd_pcm_channel_info(pcm, info)) < 0)
|
|
return err;
|
|
info->formats = snd_pcm_plugin_formats(pcm, info->formats);
|
|
return 0;
|
|
}
|
|
|
|
static int snd_pcm_plugin_action(snd_pcm_t *pcm, int channel, int action)
|
|
{
|
|
snd_pcm_plugin_t *plugin;
|
|
int err;
|
|
|
|
plugin = pcm->plugin_first[channel];
|
|
while (plugin) {
|
|
if (plugin->action) {
|
|
if ((err = plugin->action(plugin, action))<0)
|
|
return err;
|
|
}
|
|
plugin = plugin->next;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void swap_formats(int channel, int *src, int *dst)
|
|
{
|
|
int tmp;
|
|
|
|
if (channel == SND_PCM_CHANNEL_PLAYBACK)
|
|
return;
|
|
tmp = *src;
|
|
*src = *dst;
|
|
*dst = tmp;
|
|
}
|
|
|
|
#define CONVERT_RATIO(dest, ratio) dest = (int)((double)dest * ratio)
|
|
|
|
int snd_pcm_plugin_params(snd_pcm_t *pcm, snd_pcm_channel_params_t *params)
|
|
{
|
|
double ratio;
|
|
snd_pcm_channel_params_t sparams;
|
|
snd_pcm_channel_info_t sinfo;
|
|
snd_pcm_plugin_t *plugin;
|
|
int err, srcfmt, dstfmt;
|
|
|
|
if (!pcm || !params || params->channel < 0 || params->channel > 1)
|
|
return -EINVAL;
|
|
memcpy(&sparams, params, sizeof(sparams));
|
|
|
|
/*
|
|
* try to decide, if a conversion is required
|
|
*/
|
|
|
|
memset(&sinfo, 0, sizeof(sinfo));
|
|
sinfo.channel = params->channel;
|
|
if ((err = snd_pcm_channel_info(pcm, &sinfo)) < 0) {
|
|
snd_pcm_plugin_clear(pcm, params->channel);
|
|
return err;
|
|
}
|
|
if ((sinfo.formats & (1 << sparams.format.format)) == 0) {
|
|
if ((snd_pcm_plugin_formats(pcm, sinfo.formats) & (1 << sparams.format.format)) == 0)
|
|
return -EINVAL;
|
|
switch (sparams.format.format) {
|
|
case SND_PCM_SFMT_U8:
|
|
if (sinfo.formats & SND_PCM_SFMT_S8) {
|
|
sparams.format.format = SND_PCM_SFMT_S8;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_U16_LE) {
|
|
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_S16_LE) {
|
|
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case SND_PCM_SFMT_S8:
|
|
if (sinfo.formats & SND_PCM_SFMT_U8) {
|
|
sparams.format.format = SND_PCM_SFMT_U8;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_S16_LE) {
|
|
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_U16_LE) {
|
|
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case SND_PCM_SFMT_S16_LE:
|
|
if (sinfo.formats & SND_PCM_SFMT_U16_LE) {
|
|
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_S8) {
|
|
sparams.format.format = SND_PCM_SFMT_S8;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_U8) {
|
|
sparams.format.format = SND_PCM_SFMT_U8;
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case SND_PCM_SFMT_U16_LE:
|
|
if (sinfo.formats & SND_PCM_SFMT_S16_LE) {
|
|
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_U8) {
|
|
sparams.format.format = SND_PCM_SFMT_U8;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_S8) {
|
|
sparams.format.format = SND_PCM_SFMT_S8;
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case SND_PCM_SFMT_MU_LAW:
|
|
if (sinfo.formats & SND_PCM_SFMT_S16_LE) {
|
|
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_U16_LE) {
|
|
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_S8) {
|
|
sparams.format.format = SND_PCM_SFMT_S8;
|
|
} else if (sinfo.formats & SND_PCM_SFMT_U8) {
|
|
sparams.format.format = SND_PCM_SFMT_U8;
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* add necessary plugins
|
|
*/
|
|
|
|
snd_pcm_plugin_clear(pcm, params->channel);
|
|
if (sinfo.mode == SND_PCM_MODE_STREAM) {
|
|
err = snd_pcm_plugin_build_stream(pcm, params->channel, &plugin);
|
|
} else if (sinfo.mode == SND_PCM_MODE_BLOCK) {
|
|
if (sinfo.flags & SND_PCM_CHNINFO_MMAP) {
|
|
err = snd_pcm_plugin_build_mmap(pcm, params->channel, &plugin);
|
|
} else {
|
|
err = snd_pcm_plugin_build_block(pcm, params->channel, &plugin);
|
|
}
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
if (err < 0)
|
|
return err;
|
|
err = snd_pcm_plugin_insert(pcm, params->channel, plugin);
|
|
if (err < 0) {
|
|
snd_pcm_plugin_free(plugin);
|
|
return err;
|
|
}
|
|
|
|
if (params->format.voices > 1 && sinfo.mode == SND_PCM_MODE_BLOCK) {
|
|
int src_interleave, dst_interleave;
|
|
|
|
if (params->format.interleave) {
|
|
src_interleave = dst_interleave = 1;
|
|
if (!(sinfo.flags & SND_PCM_CHNINFO_INTERLEAVE))
|
|
dst_interleave = 0;
|
|
} else {
|
|
src_interleave = dst_interleave = 0;
|
|
if (!(sinfo.flags & SND_PCM_CHNINFO_NONINTERLEAVE))
|
|
dst_interleave = 1;
|
|
}
|
|
if (src_interleave != dst_interleave) {
|
|
sparams.format.interleave = dst_interleave;
|
|
swap_formats(params->channel, &src_interleave, &dst_interleave);
|
|
err = snd_pcm_plugin_build_interleave(src_interleave, dst_interleave, sparams.format.format, &plugin);
|
|
if (err < 0)
|
|
return err;
|
|
err = snd_pcm_plugin_insert(pcm, params->channel, plugin);
|
|
if (err < 0) {
|
|
snd_pcm_plugin_free(plugin);
|
|
return err;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (params->format.format == sparams.format.format)
|
|
goto __skip;
|
|
/* build additional plugins for conversion */
|
|
switch (params->format.format) {
|
|
case SND_PCM_SFMT_MU_LAW:
|
|
srcfmt = SND_PCM_SFMT_MU_LAW;
|
|
dstfmt = sparams.format.format;
|
|
swap_formats(params->channel, &srcfmt, &dstfmt);
|
|
err = snd_pcm_plugin_build_mulaw(srcfmt, dstfmt, &plugin);
|
|
break;
|
|
default:
|
|
srcfmt = params->format.format;
|
|
dstfmt = sparams.format.format;
|
|
swap_formats(params->channel, &srcfmt, &dstfmt);
|
|
err = snd_pcm_plugin_build_linear(srcfmt, dstfmt, &plugin);
|
|
}
|
|
if (err < 0)
|
|
return err;
|
|
err = snd_pcm_plugin_insert(pcm, params->channel, plugin);
|
|
if (err < 0) {
|
|
snd_pcm_plugin_free(plugin);
|
|
return err;
|
|
}
|
|
|
|
__skip:
|
|
ratio = snd_pcm_plugin_hardware_ratio(pcm, params->channel);
|
|
if (ratio <= 0)
|
|
return -EINVAL;
|
|
if (params->mode == SND_PCM_MODE_STREAM) {
|
|
CONVERT_RATIO(sparams.buf.stream.queue_size, ratio);
|
|
CONVERT_RATIO(sparams.buf.stream.max_fill, ratio);
|
|
} else if (params->mode == SND_PCM_MODE_BLOCK) {
|
|
CONVERT_RATIO(sparams.buf.block.frag_size, ratio);
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
err = snd_pcm_channel_params(pcm, &sparams);
|
|
if (err < 0)
|
|
return err;
|
|
err = snd_pcm_plugin_action(pcm, sparams.channel, INIT);
|
|
if (err < 0)
|
|
return err;
|
|
return 0;
|
|
}
|
|
|
|
int snd_pcm_plugin_setup(snd_pcm_t *pcm, snd_pcm_channel_setup_t *setup)
|
|
{
|
|
double ratio;
|
|
int err;
|
|
|
|
if (!pcm || !setup || setup->channel < 0 || setup->channel > 1)
|
|
return -EINVAL;
|
|
err = snd_pcm_channel_setup(pcm, setup);
|
|
if (err < 0)
|
|
return err;
|
|
ratio = snd_pcm_plugin_transfer_ratio(pcm, setup->channel);
|
|
if (ratio <= 0)
|
|
return -EINVAL;
|
|
if (setup->mode == SND_PCM_MODE_STREAM) {
|
|
CONVERT_RATIO(setup->buf.stream.queue_size, ratio);
|
|
} else if (setup->mode == SND_PCM_MODE_BLOCK) {
|
|
CONVERT_RATIO(setup->buf.block.frag_size, ratio);
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int snd_pcm_plugin_status(snd_pcm_t *pcm, snd_pcm_channel_status_t *status)
|
|
{
|
|
double ratio;
|
|
int err;
|
|
|
|
if (!pcm || !status || status->channel < 0 || status->channel > 1)
|
|
return -EINVAL;
|
|
err = snd_pcm_channel_status(pcm, status);
|
|
if (err < 0)
|
|
return err;
|
|
ratio = snd_pcm_plugin_transfer_ratio(pcm, status->channel);
|
|
if (ratio <= 0)
|
|
return -EINVAL;
|
|
CONVERT_RATIO(status->scount, ratio);
|
|
CONVERT_RATIO(status->count, ratio);
|
|
CONVERT_RATIO(status->free, ratio);
|
|
return 0;
|
|
}
|
|
|
|
int snd_pcm_plugin_prepare(snd_pcm_t *pcm, int channel)
|
|
{
|
|
int err;
|
|
|
|
if ((err = snd_pcm_plugin_action(pcm, channel, PREPARE))<0)
|
|
return err;
|
|
return snd_pcm_channel_prepare(pcm, channel);
|
|
}
|
|
|
|
int snd_pcm_plugin_drain_playback(snd_pcm_t *pcm)
|
|
{
|
|
int err;
|
|
|
|
if ((err = snd_pcm_plugin_action(pcm, SND_PCM_CHANNEL_PLAYBACK, DRAIN))<0)
|
|
return err;
|
|
return snd_pcm_drain_playback(pcm);
|
|
}
|
|
|
|
int snd_pcm_plugin_flush(snd_pcm_t *pcm, int channel)
|
|
{
|
|
int err;
|
|
|
|
if ((err = snd_pcm_plugin_action(pcm, channel, FLUSH))<0)
|
|
return err;
|
|
return snd_pcm_flush_channel(pcm, channel);
|
|
}
|
|
|
|
int snd_pcm_plugin_pointer(snd_pcm_t *pcm, int channel, void **ptr, size_t *size)
|
|
{
|
|
snd_pcm_plugin_t *plugin;
|
|
int err;
|
|
|
|
if (!ptr || !size)
|
|
return -EINVAL;
|
|
*ptr = NULL;
|
|
if (!pcm || channel < 0 || channel > 1)
|
|
return -EINVAL;
|
|
plugin = pcm->plugin_first[channel];
|
|
if (!plugin)
|
|
return -EINVAL;
|
|
if (plugin->transfer_src_ptr) {
|
|
err = plugin->transfer_src_ptr(plugin, (char **)ptr, size);
|
|
if (err >= 0)
|
|
return 0;
|
|
}
|
|
if (pcm->plugin_alloc_xptr[channel]) {
|
|
if (pcm->plugin_alloc_xsize[channel] >= *size) {
|
|
*ptr = (char *)pcm->plugin_alloc_xptr[channel];
|
|
return 0;
|
|
}
|
|
*ptr = (char *)realloc(pcm->plugin_alloc_xptr[channel], *size);
|
|
} else {
|
|
*ptr = (char *)malloc(*size);
|
|
if (*ptr != NULL)
|
|
pcm->plugin_alloc_xsize[channel] = *size;
|
|
}
|
|
if (*ptr == NULL)
|
|
return -ENOMEM;
|
|
pcm->plugin_alloc_xptr[channel] = *ptr;
|
|
return 0;
|
|
}
|
|
|
|
static void *snd_pcm_plugin_malloc(snd_pcm_t *pcm, long size)
|
|
{
|
|
int idx;
|
|
void *ptr;
|
|
|
|
for (idx = 0; idx < 4; idx++) {
|
|
if (pcm->plugin_alloc_lock[idx])
|
|
continue;
|
|
if (pcm->plugin_alloc_ptr[idx] == NULL)
|
|
continue;
|
|
if (pcm->plugin_alloc_size[idx] >= size) {
|
|
pcm->plugin_alloc_lock[idx] = 1;
|
|
return pcm->plugin_alloc_ptr[idx];
|
|
}
|
|
}
|
|
for (idx = 0; idx < 4; idx++) {
|
|
if (pcm->plugin_alloc_lock[idx])
|
|
continue;
|
|
if (pcm->plugin_alloc_ptr[idx] == NULL)
|
|
continue;
|
|
ptr = realloc(pcm->plugin_alloc_ptr[idx], size);
|
|
if (ptr == NULL)
|
|
continue;
|
|
pcm->plugin_alloc_size[idx] = size;
|
|
pcm->plugin_alloc_lock[idx] = 1;
|
|
return pcm->plugin_alloc_ptr[idx] = ptr;
|
|
}
|
|
for (idx = 0; idx < 4; idx++) {
|
|
if (pcm->plugin_alloc_ptr[idx] != NULL)
|
|
continue;
|
|
ptr = malloc(size);
|
|
if (ptr == NULL)
|
|
continue;
|
|
pcm->plugin_alloc_size[idx] = size;
|
|
pcm->plugin_alloc_lock[idx] = 1;
|
|
return pcm->plugin_alloc_ptr[idx] = ptr;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static int snd_pcm_plugin_alloc_unlock(snd_pcm_t *pcm, void *ptr)
|
|
{
|
|
int idx;
|
|
|
|
for (idx = 0; idx < 4; idx++) {
|
|
if (pcm->plugin_alloc_ptr[idx] == ptr) {
|
|
pcm->plugin_alloc_lock[idx] = 0;
|
|
return 0;
|
|
}
|
|
}
|
|
return -ENOENT;
|
|
}
|
|
|
|
ssize_t snd_pcm_plugin_write(snd_pcm_t *pcm, const void *buffer, size_t count)
|
|
{
|
|
snd_pcm_plugin_t *plugin, *next;
|
|
char *dst_ptr, *dst_ptr1 = NULL, *src_ptr, *src_ptr1 = NULL;
|
|
size_t dst_size, src_size;
|
|
ssize_t size = 0, result = 0;
|
|
int err;
|
|
|
|
if ((plugin = snd_pcm_plugin_first(pcm, SND_PCM_CHANNEL_PLAYBACK)) == NULL)
|
|
return snd_pcm_write(pcm, buffer, count);
|
|
src_ptr = (char *)buffer;
|
|
dst_size = src_size = count;
|
|
while (plugin) {
|
|
next = plugin->next;
|
|
if (plugin->dst_size) {
|
|
dst_size = plugin->dst_size(plugin, dst_size);
|
|
if (dst_size < 0) {
|
|
result = dst_size;
|
|
goto __free;
|
|
}
|
|
}
|
|
if (next != NULL) {
|
|
if (next->transfer_src_ptr) {
|
|
if ((err = next->transfer_src_ptr(next, &dst_ptr, &dst_size)) < 0) {
|
|
if (dst_ptr == NULL)
|
|
goto __alloc;
|
|
result = err;
|
|
goto __free;
|
|
}
|
|
} else {
|
|
__alloc:
|
|
dst_ptr = dst_ptr1 = (char *)snd_pcm_plugin_malloc(pcm, dst_size);
|
|
if (dst_ptr == NULL) {
|
|
result = -ENOMEM;
|
|
goto __free;
|
|
}
|
|
}
|
|
} else {
|
|
dst_ptr = src_ptr;
|
|
dst_size = src_size;
|
|
}
|
|
if ((size = plugin->transfer(plugin, src_ptr, src_size,
|
|
dst_ptr, dst_size))<0) {
|
|
result = size;
|
|
goto __free;
|
|
}
|
|
if (src_ptr1)
|
|
snd_pcm_plugin_alloc_unlock(pcm, src_ptr1);
|
|
plugin = plugin->next;
|
|
src_ptr = dst_ptr;
|
|
src_ptr1 = dst_ptr1;
|
|
dst_ptr1 = NULL;
|
|
src_size = dst_size = size;
|
|
}
|
|
result = snd_pcm_plugin_transfer_size(pcm, SND_PCM_CHANNEL_PLAYBACK, size);
|
|
__free:
|
|
if (dst_ptr1)
|
|
snd_pcm_plugin_alloc_unlock(pcm, dst_ptr1);
|
|
if (src_ptr1)
|
|
snd_pcm_plugin_alloc_unlock(pcm, src_ptr1);
|
|
return result;
|
|
}
|
|
|
|
ssize_t snd_pcm_plugin_read(snd_pcm_t *pcm, void *buffer, size_t count)
|
|
{
|
|
snd_pcm_plugin_t *plugin, *prev;
|
|
char *dst_ptr, *dst_ptr1 = NULL, *src_ptr, *src_ptr1 = NULL;
|
|
size_t dst_size, src_size;
|
|
ssize_t size = 0, result = 0;
|
|
int err;
|
|
|
|
if ((plugin = snd_pcm_plugin_last(pcm, SND_PCM_CHANNEL_CAPTURE)) == NULL)
|
|
return snd_pcm_read(pcm, buffer, count);
|
|
src_ptr = NULL;
|
|
src_size = 0;
|
|
dst_size = snd_pcm_plugin_hardware_size(pcm, SND_PCM_CHANNEL_CAPTURE, count);
|
|
if (dst_size < 0)
|
|
return dst_size;
|
|
while (plugin) {
|
|
prev = plugin->prev;
|
|
if (plugin->dst_size) {
|
|
dst_size = plugin->dst_size(plugin, dst_size);
|
|
if (dst_size < 0) {
|
|
result = dst_size;
|
|
goto __free;
|
|
}
|
|
}
|
|
if (prev != NULL) {
|
|
if (prev->transfer_src_ptr) {
|
|
if ((err = prev->transfer_src_ptr(prev, &dst_ptr, &dst_size)) < 0) {
|
|
if (dst_ptr == NULL)
|
|
goto __alloc;
|
|
result = err;
|
|
goto __free;
|
|
}
|
|
} else {
|
|
__alloc:
|
|
dst_ptr = dst_ptr1 = (char *)snd_pcm_plugin_malloc(pcm, dst_size);
|
|
if (dst_ptr == NULL) {
|
|
result = -ENOMEM;
|
|
goto __free;
|
|
}
|
|
}
|
|
} else {
|
|
dst_ptr = buffer;
|
|
}
|
|
if ((size = plugin->transfer(plugin, src_ptr, src_size,
|
|
dst_ptr, dst_size))<0) {
|
|
result = size;
|
|
goto __free;
|
|
}
|
|
if (dst_ptr1)
|
|
snd_pcm_plugin_alloc_unlock(pcm, dst_ptr1);
|
|
plugin = plugin->prev;
|
|
src_ptr = dst_ptr;
|
|
src_ptr1 = dst_ptr1;
|
|
dst_ptr1 = NULL;
|
|
src_size = dst_size = size;
|
|
}
|
|
result = size;
|
|
__free:
|
|
if (dst_ptr1)
|
|
snd_pcm_plugin_alloc_unlock(pcm, dst_ptr1);
|
|
if (src_ptr1)
|
|
snd_pcm_plugin_alloc_unlock(pcm, src_ptr1);
|
|
return result;
|
|
}
|