mirror of
https://github.com/alsa-project/alsa-lib.git
synced 2025-11-04 13:30:08 -05:00
Added route plugin
This commit is contained in:
Abramo Bagnara
parent
bce4a22410
commit
6949222d36
1 changed files with 433 additions and 0 deletions
433
src/pcm/plugin/route.c
Normal file
433
src/pcm/plugin/route.c
Normal file
|
|
@ -0,0 +1,433 @@
|
|||
/*
|
||||
* Attenuated route Plug-In
|
||||
* Copyright (c) 2000 by Abramo Bagnara <abbagnara@racine.ra.it>
|
||||
*
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
|
||||
#ifdef __KERNEL__
|
||||
#include "../../include/driver.h"
|
||||
#include "../../include/pcm.h"
|
||||
#include "../../include/pcm_plugin.h"
|
||||
#define bswap_16(x) __swab16((x))
|
||||
#define bswap_32(x) __swab32((x))
|
||||
#else
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <unistd.h>
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include <endian.h>
|
||||
#include <byteswap.h>
|
||||
#include "../pcm_local.h"
|
||||
#endif
|
||||
|
||||
#define ROUTE_PLUGIN_RESOLUTION 16
|
||||
|
||||
struct route_private_data;
|
||||
|
||||
typedef void (*route_f)(struct route_private_data *data,
|
||||
void *src_ptr, void *dst_ptr,
|
||||
size_t src_size, size_t dst_size);
|
||||
|
||||
struct route_private_data {
|
||||
int sample_size; /* Bytes per sample */
|
||||
route_f func;
|
||||
int interleave;
|
||||
int format;
|
||||
int src_voices;
|
||||
int dst_voices;
|
||||
int ttable[0];
|
||||
};
|
||||
|
||||
static void route_noop(struct route_private_data *data,
|
||||
void *src_ptr, void *dst_ptr,
|
||||
size_t src_size, size_t dst_size)
|
||||
{
|
||||
memcpy(dst_ptr, src_ptr, src_size);
|
||||
}
|
||||
|
||||
static void route_i_silence(struct route_private_data *data,
|
||||
void *src_ptr, void *dst_ptr,
|
||||
size_t src_size, size_t dst_size)
|
||||
{
|
||||
char *src = src_ptr;
|
||||
char *dst = dst_ptr;
|
||||
int sil = snd_pcm_format_silence(data->format);
|
||||
int src_step = data->sample_size * data->src_voices;
|
||||
int dst_step = data->sample_size * data->dst_voices;
|
||||
char *end = dst + dst_size;
|
||||
if (data->src_voices < data->dst_voices) {
|
||||
while (dst < end) {
|
||||
int i;
|
||||
for (i = 0; i < src_step; ++i)
|
||||
*dst++ = *src++;
|
||||
for (; i < dst_step; ++i)
|
||||
*dst++ = sil;
|
||||
}
|
||||
} else {
|
||||
while (dst < end) {
|
||||
int i;
|
||||
for (i = 0; i < dst_step; ++i)
|
||||
*dst++ = *src++;
|
||||
src += src_step - dst_step;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void route_n_silence(struct route_private_data *data,
|
||||
void *src_ptr, void *dst_ptr,
|
||||
size_t src_size, size_t dst_size)
|
||||
{
|
||||
if (src_size < dst_size) {
|
||||
memcpy(dst_ptr, src_ptr, src_size);
|
||||
memset(dst_ptr + src_size, snd_pcm_format_silence(data->format), dst_size - src_size);
|
||||
} else {
|
||||
memcpy(dst_ptr, src_ptr, dst_size);
|
||||
}
|
||||
}
|
||||
|
||||
#define ROUTE_I_FUNC(name, type, ttype, toh, hto, mul, div) \
|
||||
static void name(struct route_private_data *data, \
|
||||
void *src_ptr, void *dst_ptr, \
|
||||
size_t src_size, size_t dst_size) \
|
||||
{ \
|
||||
type *src = src_ptr; \
|
||||
type *dst = dst_ptr; \
|
||||
int src_voices = data->src_voices; \
|
||||
int dst_voices = data->dst_voices; \
|
||||
int *ttable = data->ttable; \
|
||||
size_t samples = src_size / (src_voices * data->sample_size); \
|
||||
while (samples-- > 0) { \
|
||||
int dst_voice; \
|
||||
int *ttp = ttable; \
|
||||
for (dst_voice = 0; dst_voice < dst_voices; ++dst_voice) { \
|
||||
int src_voice; \
|
||||
type *s = src; \
|
||||
ttype t = 0; \
|
||||
for (src_voice = 0; src_voice < src_voices; ++src_voice) { \
|
||||
ttype v = toh(*s); \
|
||||
t += mul(v, *ttp); \
|
||||
s++; \
|
||||
ttp++; \
|
||||
} \
|
||||
t = div(t, ROUTE_PLUGIN_RESOLUTION); \
|
||||
*dst++ = hto(t); \
|
||||
} \
|
||||
src += src_voices; \
|
||||
} \
|
||||
}
|
||||
|
||||
#define ROUTE_N_FUNC(name, type, ttype, toh, hto, mul, div) \
|
||||
static void name(struct route_private_data *data, \
|
||||
void *src_ptr, void *dst_ptr, \
|
||||
size_t src_size, size_t dst_size) \
|
||||
{ \
|
||||
type *src = src_ptr; \
|
||||
type *dst = dst_ptr; \
|
||||
int src_voices = data->src_voices; \
|
||||
int dst_voices = data->dst_voices; \
|
||||
int *ttable = data->ttable; \
|
||||
size_t samples = src_size / (src_voices * data->sample_size); \
|
||||
int dst_voice; \
|
||||
for (dst_voice = 0; dst_voice < dst_voices; ++dst_voice) { \
|
||||
int *ttp = ttable + dst_voice * src_voices; \
|
||||
size_t samples1 = samples; \
|
||||
while (samples1-- > 0) { \
|
||||
int *ttp1 = ttp; \
|
||||
type *s = src; \
|
||||
ttype t = 0; \
|
||||
int src_voice; \
|
||||
for (src_voice = 0; src_voice < src_voices; ++src_voice) { \
|
||||
ttype v = toh(*s); \
|
||||
t += mul(v, *ttp1); \
|
||||
s += samples; \
|
||||
ttp1++; \
|
||||
} \
|
||||
t = div(t, ROUTE_PLUGIN_RESOLUTION); \
|
||||
*dst++ = hto(t); \
|
||||
src++; \
|
||||
} \
|
||||
} \
|
||||
}
|
||||
|
||||
#define none(p) (p)
|
||||
#if __BYTE_ORDER == __LITTLE_ENDIAN
|
||||
#define le16toh none
|
||||
#define htole16 none
|
||||
#define le32toh none
|
||||
#define htole32 none
|
||||
#define be16toh bswap_16
|
||||
#define htobe16 bswap_16
|
||||
#define be32toh bswap_32
|
||||
#define htobe32 bswap_32
|
||||
#elif __BYTE_ORDER == __BIG_ENDIAN
|
||||
#define le16toh bswap_16
|
||||
#define htole16 bswap_16
|
||||
#define le32toh bswap_32
|
||||
#define htole32 bswap_32
|
||||
#define be16toh none
|
||||
#define htobe16 none
|
||||
#define be32toh none
|
||||
#define htobe32 none
|
||||
#else
|
||||
#error "Unsupported endian..."
|
||||
#endif
|
||||
|
||||
#define mul(a,b) ((a)*(b))
|
||||
#define div(a,b) ((a)/(b))
|
||||
#define nmul(a,b) ((b)?(a):0)
|
||||
#define ndiv(a,b) (a)
|
||||
|
||||
#define FUNCS(name, type, ttype, toh, hto) \
|
||||
ROUTE_I_FUNC(aroute_i_##name, type, ttype, toh, hto, mul, div); \
|
||||
ROUTE_N_FUNC(aroute_n_##name, type, ttype, toh, hto, mul, div); \
|
||||
ROUTE_I_FUNC(nroute_i_##name, type, ttype, toh, hto, nmul, ndiv); \
|
||||
ROUTE_N_FUNC(nroute_n_##name, type, ttype, toh, hto, nmul, ndiv);
|
||||
|
||||
|
||||
FUNCS(s8, int8_t, int, none, none);
|
||||
FUNCS(u8, u_int8_t, int, none, none);
|
||||
FUNCS(s16_le, int16_t, int, le16toh,htole16);
|
||||
FUNCS(u16_le, u_int16_t, int, le16toh,htole16);
|
||||
FUNCS(s16_be, int16_t, int, be16toh,htobe16);
|
||||
FUNCS(u16_be, u_int16_t, int, be16toh,htobe16);
|
||||
FUNCS(s24_le, int32_t, int, le32toh,htole32);
|
||||
FUNCS(u24_le, u_int32_t, int, le32toh,htole32);
|
||||
FUNCS(s24_be, int32_t, int, be32toh,htobe32);
|
||||
FUNCS(u24_be, u_int32_t, int, be32toh,htobe32);
|
||||
FUNCS(s32_le, int32_t, int64_t,le32toh,htole32);
|
||||
FUNCS(u32_le, u_int32_t, int64_t,le32toh,htole32);
|
||||
FUNCS(s32_be, int32_t, int64_t,be32toh,htobe32);
|
||||
FUNCS(u32_be, u_int32_t, int64_t,be32toh,htobe32);
|
||||
|
||||
|
||||
static route_f aroute_i[] = {
|
||||
[SND_PCM_SFMT_S8] aroute_i_s8,
|
||||
[SND_PCM_SFMT_U8] aroute_i_u8,
|
||||
[SND_PCM_SFMT_S16_LE] aroute_i_s16_le,
|
||||
[SND_PCM_SFMT_S16_BE] aroute_i_s16_be,
|
||||
[SND_PCM_SFMT_U16_LE] aroute_i_u16_le,
|
||||
[SND_PCM_SFMT_U16_BE] aroute_i_u16_be,
|
||||
[SND_PCM_SFMT_S24_LE] aroute_i_s24_le,
|
||||
[SND_PCM_SFMT_S24_BE] aroute_i_s24_be,
|
||||
[SND_PCM_SFMT_U24_LE] aroute_i_u24_le,
|
||||
[SND_PCM_SFMT_U24_BE] aroute_i_u24_be,
|
||||
[SND_PCM_SFMT_S32_LE] aroute_i_s32_le,
|
||||
[SND_PCM_SFMT_S32_BE] aroute_i_s32_be,
|
||||
[SND_PCM_SFMT_U32_LE] aroute_i_u32_le,
|
||||
[SND_PCM_SFMT_U32_BE] aroute_i_u32_be
|
||||
};
|
||||
|
||||
static route_f aroute_n[] = {
|
||||
[SND_PCM_SFMT_S8] aroute_n_s8,
|
||||
[SND_PCM_SFMT_U8] aroute_n_u8,
|
||||
[SND_PCM_SFMT_S16_LE] aroute_n_s16_le,
|
||||
[SND_PCM_SFMT_S16_BE] aroute_n_s16_be,
|
||||
[SND_PCM_SFMT_U16_LE] aroute_n_u16_le,
|
||||
[SND_PCM_SFMT_U16_BE] aroute_n_u16_be,
|
||||
[SND_PCM_SFMT_S24_LE] aroute_n_s24_le,
|
||||
[SND_PCM_SFMT_S24_BE] aroute_n_s24_be,
|
||||
[SND_PCM_SFMT_U24_LE] aroute_n_u24_le,
|
||||
[SND_PCM_SFMT_U24_BE] aroute_n_u24_be,
|
||||
[SND_PCM_SFMT_S32_LE] aroute_n_s32_le,
|
||||
[SND_PCM_SFMT_S32_BE] aroute_n_s32_be,
|
||||
[SND_PCM_SFMT_U32_LE] aroute_n_u32_le,
|
||||
[SND_PCM_SFMT_U32_BE] aroute_n_u32_be
|
||||
};
|
||||
|
||||
static route_f nroute_i[] = {
|
||||
[SND_PCM_SFMT_S8] nroute_i_s8,
|
||||
[SND_PCM_SFMT_U8] nroute_i_u8,
|
||||
[SND_PCM_SFMT_S16_LE] nroute_i_s16_le,
|
||||
[SND_PCM_SFMT_S16_BE] nroute_i_s16_be,
|
||||
[SND_PCM_SFMT_U16_LE] nroute_i_u16_le,
|
||||
[SND_PCM_SFMT_U16_BE] nroute_i_u16_be,
|
||||
[SND_PCM_SFMT_S24_LE] nroute_i_s24_le,
|
||||
[SND_PCM_SFMT_S24_BE] nroute_i_s24_be,
|
||||
[SND_PCM_SFMT_U24_LE] nroute_i_u24_le,
|
||||
[SND_PCM_SFMT_U24_BE] nroute_i_u24_be,
|
||||
[SND_PCM_SFMT_S32_LE] nroute_i_s32_le,
|
||||
[SND_PCM_SFMT_S32_BE] nroute_i_s32_be,
|
||||
[SND_PCM_SFMT_U32_LE] nroute_i_u32_le,
|
||||
[SND_PCM_SFMT_U32_BE] nroute_i_u32_be
|
||||
};
|
||||
|
||||
static route_f nroute_n[] = {
|
||||
[SND_PCM_SFMT_S8] nroute_n_s8,
|
||||
[SND_PCM_SFMT_U8] nroute_n_u8,
|
||||
[SND_PCM_SFMT_S16_LE] nroute_n_s16_le,
|
||||
[SND_PCM_SFMT_S16_BE] nroute_n_s16_be,
|
||||
[SND_PCM_SFMT_U16_LE] nroute_n_u16_le,
|
||||
[SND_PCM_SFMT_U16_BE] nroute_n_u16_be,
|
||||
[SND_PCM_SFMT_S24_LE] nroute_n_s24_le,
|
||||
[SND_PCM_SFMT_S24_BE] nroute_n_s24_be,
|
||||
[SND_PCM_SFMT_U24_LE] nroute_n_u24_le,
|
||||
[SND_PCM_SFMT_U24_BE] nroute_n_u24_be,
|
||||
[SND_PCM_SFMT_S32_LE] nroute_n_s32_le,
|
||||
[SND_PCM_SFMT_S32_BE] nroute_n_s32_be,
|
||||
[SND_PCM_SFMT_U32_LE] nroute_n_u32_le,
|
||||
[SND_PCM_SFMT_U32_BE] nroute_n_u32_be
|
||||
};
|
||||
|
||||
static int route_load_ttable(struct route_private_data *data,
|
||||
const int *src_ttable)
|
||||
{
|
||||
int src_voice, dst_voice;
|
||||
const int *sptr;
|
||||
int *dptr;
|
||||
int noop = 1;
|
||||
int noatt = 1;
|
||||
if (src_ttable == NULL)
|
||||
return 0;
|
||||
dptr = data->ttable;
|
||||
sptr = src_ttable;
|
||||
for (dst_voice = 0; dst_voice < data->dst_voices; ++dst_voice) {
|
||||
int t = 0;
|
||||
for (src_voice = 0; src_voice < data->src_voices; ++src_voice) {
|
||||
if (*sptr < 0 || *sptr > ROUTE_PLUGIN_RESOLUTION)
|
||||
return -EINVAL;
|
||||
if (*sptr != 0 && *sptr != ROUTE_PLUGIN_RESOLUTION)
|
||||
noatt = 0;
|
||||
if (src_voice == dst_voice) {
|
||||
if (*sptr != ROUTE_PLUGIN_RESOLUTION)
|
||||
noop = 0;
|
||||
}
|
||||
else {
|
||||
if (*sptr != 0)
|
||||
noop = 0;
|
||||
}
|
||||
t += *sptr;
|
||||
*dptr++ = *sptr++;
|
||||
}
|
||||
#if 0
|
||||
if (t > ROUTE_PLUGIN_RESOLUTION)
|
||||
return -EINVAL;
|
||||
#endif
|
||||
}
|
||||
if (noop) {
|
||||
if (data->src_voices == data->dst_voices)
|
||||
data->func = route_noop;
|
||||
else if (data->interleave)
|
||||
data->func = route_i_silence;
|
||||
else
|
||||
data->func = route_n_silence;
|
||||
return 0;
|
||||
}
|
||||
if (noatt) {
|
||||
if (data->interleave)
|
||||
data->func = nroute_i[data->format];
|
||||
else
|
||||
data->func = nroute_n[data->format];
|
||||
} else {
|
||||
if (data->interleave)
|
||||
data->func = aroute_i[data->format];
|
||||
else
|
||||
data->func = aroute_n[data->format];
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static ssize_t route_transfer(snd_pcm_plugin_t *plugin,
|
||||
char *src_ptr, size_t src_size,
|
||||
char *dst_ptr, size_t dst_size)
|
||||
{
|
||||
struct route_private_data *data;
|
||||
if (plugin == NULL || src_ptr == NULL || src_size < 0 ||
|
||||
dst_ptr == NULL || dst_size < 0)
|
||||
return -EINVAL;
|
||||
if (src_size == 0)
|
||||
return 0;
|
||||
data = (struct route_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
data->func(data, src_ptr, dst_ptr, src_size, dst_size);
|
||||
return dst_size;
|
||||
}
|
||||
|
||||
static ssize_t route_src_size(snd_pcm_plugin_t *plugin, size_t size)
|
||||
{
|
||||
struct route_private_data *data;
|
||||
|
||||
if (plugin == NULL || size <= 0)
|
||||
return -EINVAL;
|
||||
data = (struct route_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
if (!plugin || size <= 0)
|
||||
return -EINVAL;
|
||||
return (size * data->src_voices) / data->dst_voices;
|
||||
}
|
||||
|
||||
static ssize_t route_dst_size(snd_pcm_plugin_t *plugin, size_t size)
|
||||
{
|
||||
struct route_private_data *data;
|
||||
|
||||
if (plugin == NULL || size <= 0)
|
||||
return -EINVAL;
|
||||
data = (struct route_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
if (!plugin || size <= 0)
|
||||
return -EINVAL;
|
||||
return (size * data->dst_voices) / data->src_voices;
|
||||
}
|
||||
|
||||
int snd_pcm_plugin_build_route(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
int *ttable,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct route_private_data *data;
|
||||
snd_pcm_plugin_t *plugin;
|
||||
int size;
|
||||
int err;
|
||||
|
||||
if (!r_plugin)
|
||||
return -EINVAL;
|
||||
*r_plugin = NULL;
|
||||
if (src_format->interleave != dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (!dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (src_format->format != dst_format->format)
|
||||
return -EINVAL;
|
||||
if (!snd_pcm_format_linear(src_format->format))
|
||||
return -EINVAL;
|
||||
if (src_format->rate != dst_format->rate)
|
||||
return -EINVAL;
|
||||
if (src_format->voices < 1 || dst_format->voices < 1)
|
||||
return -EINVAL;
|
||||
size = snd_pcm_format_size(src_format->format, 1);
|
||||
if (size < 0)
|
||||
return -EINVAL;
|
||||
plugin = snd_pcm_plugin_build("Volume/balance conversion",
|
||||
sizeof(struct route_private_data) +
|
||||
sizeof(data->ttable[0]) * src_format->voices * dst_format->voices);
|
||||
if (plugin == NULL)
|
||||
return -ENOMEM;
|
||||
data = (struct route_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
|
||||
data->src_voices = src_format->voices;
|
||||
data->dst_voices = dst_format->voices;
|
||||
data->format = src_format->format;
|
||||
data->interleave = src_format->interleave;
|
||||
data->sample_size = size;
|
||||
if ((err = route_load_ttable(data, ttable)) < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
plugin->transfer = route_transfer;
|
||||
plugin->src_size = route_src_size;
|
||||
plugin->dst_size = route_dst_size;
|
||||
*r_plugin = plugin;
|
||||
return 0;
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue