mirror of
https://github.com/alsa-project/alsa-lib.git
synced 2025-10-29 05:40:25 -04:00
PCM plugin patches made by Abramo Bagnara.
Added new plugin - voice & balance.
This commit is contained in:
parent
7167132eed
commit
78dc424b72
11 changed files with 580 additions and 260 deletions
|
|
@ -122,17 +122,31 @@ int snd_pcm_plugin_build_stream(snd_pcm_t *handle, int channel, snd_pcm_plugin_t
|
|||
int snd_pcm_plugin_build_block(snd_pcm_t *handle, int channel, snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_mmap(snd_pcm_t *handle, int channel, snd_pcm_plugin_t **r_plugin);
|
||||
/* conversion plugins */
|
||||
int snd_pcm_plugin_build_interleave(int src_interleave, int dst_interleave, int format, snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_linear(int src_format, int dst_format, snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_mulaw(int src_format, int dst_format, snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_alaw(int src_format, int dst_format, snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_adpcm(int src_format, int dst_format, snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_rate(int src_format, int src_rate, int src_voices,
|
||||
int dst_format, int dst_rate, int dst_voices,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_voices(int src_format, int src_voices,
|
||||
int dst_format, int dst_voices,
|
||||
int snd_pcm_plugin_build_interleave(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_linear(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_mulaw(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_alaw(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_adpcm(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_rate(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_voices(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
int snd_pcm_plugin_build_volbal(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
int *ttable,
|
||||
snd_pcm_plugin_t **r_plugin);
|
||||
|
||||
/*
|
||||
* Loopback interface
|
||||
|
|
|
|||
|
|
@ -285,123 +285,111 @@ static int snd_pcm_plugin_action(snd_pcm_t *pcm, int channel, int action)
|
|||
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)+0.5))
|
||||
|
||||
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_channel_params_t hwparams;
|
||||
snd_pcm_channel_params_t srcparams, tmpparams;
|
||||
snd_pcm_channel_params_t *dstparams;
|
||||
snd_pcm_channel_info_t hwinfo;
|
||||
snd_pcm_plugin_t *plugin;
|
||||
int err, srcfmt, dstfmt;
|
||||
int err;
|
||||
|
||||
if (!pcm || !params || params->channel < 0 || params->channel > 1)
|
||||
return -EINVAL;
|
||||
memcpy(&sparams, params, sizeof(sparams));
|
||||
memcpy(&hwparams, params, sizeof(hwparams));
|
||||
|
||||
/*
|
||||
* 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) {
|
||||
memset(&hwinfo, 0, sizeof(hwinfo));
|
||||
hwinfo.channel = params->channel;
|
||||
if ((err = snd_pcm_channel_info(pcm, &hwinfo)) < 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)
|
||||
if ((hwinfo.formats & (1 << params->format.format)) == 0) {
|
||||
if ((snd_pcm_plugin_formats(pcm, hwinfo.formats) & (1 << params->format.format)) == 0)
|
||||
return -EINVAL;
|
||||
switch (sparams.format.format) {
|
||||
switch (params->format.format) {
|
||||
case SND_PCM_SFMT_U8:
|
||||
if (sinfo.formats & SND_PCM_FMT_S8) {
|
||||
sparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
if (hwinfo.formats & SND_PCM_FMT_S8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case SND_PCM_SFMT_S8:
|
||||
if (sinfo.formats & SND_PCM_FMT_U8) {
|
||||
sparams.format.format = SND_PCM_SFMT_U8;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
if (hwinfo.formats & SND_PCM_FMT_U8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U8;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case SND_PCM_SFMT_S16_LE:
|
||||
if (sinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_S8) {
|
||||
sparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U8) {
|
||||
sparams.format.format = SND_PCM_SFMT_U8;
|
||||
if (hwinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_S8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U8;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case SND_PCM_SFMT_U16_LE:
|
||||
if (sinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U8) {
|
||||
sparams.format.format = SND_PCM_SFMT_U8;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_S8) {
|
||||
sparams.format.format = SND_PCM_SFMT_S8;
|
||||
if (hwinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U8;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_S8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case SND_PCM_SFMT_MU_LAW:
|
||||
if (sinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_S8) {
|
||||
sparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U8) {
|
||||
sparams.format.format = SND_PCM_SFMT_U8;
|
||||
if (hwinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_S8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U8;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case SND_PCM_SFMT_A_LAW:
|
||||
if (sinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_S8) {
|
||||
sparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U8) {
|
||||
sparams.format.format = SND_PCM_SFMT_U8;
|
||||
if (hwinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_S8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U8;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
case SND_PCM_SFMT_IMA_ADPCM:
|
||||
if (sinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
sparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_S8) {
|
||||
sparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (sinfo.formats & SND_PCM_FMT_U8) {
|
||||
sparams.format.format = SND_PCM_SFMT_U8;
|
||||
if (hwinfo.formats & SND_PCM_FMT_S16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U16_LE) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U16_LE;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_S8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_S8;
|
||||
} else if (hwinfo.formats & SND_PCM_FMT_U8) {
|
||||
hwparams.format.format = SND_PCM_SFMT_U8;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
|
@ -411,24 +399,147 @@ int snd_pcm_plugin_params(snd_pcm_t *pcm, snd_pcm_channel_params_t *params)
|
|||
}
|
||||
}
|
||||
|
||||
/* voices */
|
||||
if (params->format.voices < hwinfo.min_voices ||
|
||||
params->format.voices > hwinfo.max_voices) {
|
||||
int dst_voices = params->format.voices < hwinfo.min_voices ?
|
||||
hwinfo.min_voices : hwinfo.max_voices;
|
||||
if ((params->format.rate < hwinfo.min_rate ||
|
||||
params->format.rate > hwinfo.max_rate) &&
|
||||
dst_voices > 2)
|
||||
dst_voices = 2;
|
||||
hwparams.format.voices = dst_voices;
|
||||
}
|
||||
|
||||
/* rate */
|
||||
if (params->format.rate < hwinfo.min_rate ||
|
||||
params->format.rate > hwinfo.max_rate) {
|
||||
int dst_rate = params->format.rate < hwinfo.min_rate ?
|
||||
hwinfo.min_rate : hwinfo.max_rate;
|
||||
hwparams.format.rate = dst_rate;
|
||||
}
|
||||
|
||||
/* interleave */
|
||||
hwparams.format.interleave = params->format.interleave;
|
||||
if (!(hwinfo.flags & SND_PCM_CHNINFO_INTERLEAVE))
|
||||
hwparams.format.interleave = 0;
|
||||
if (!(hwinfo.flags & SND_PCM_CHNINFO_NONINTERLEAVE))
|
||||
hwparams.format.interleave = 1;
|
||||
|
||||
/*
|
||||
* add necessary plugins
|
||||
*/
|
||||
|
||||
snd_pcm_plugin_clear(pcm, params->channel);
|
||||
|
||||
if (sparams.format.voices < sinfo.min_voices ||
|
||||
sparams.format.voices > sinfo.max_voices) {
|
||||
int src_voices = sparams.format.voices;
|
||||
int dst_voices = sparams.format.voices < sinfo.min_voices ?
|
||||
sinfo.min_voices : sinfo.max_voices;
|
||||
if (sparams.format.rate < sinfo.min_rate ||
|
||||
sparams.format.rate > sinfo.max_rate)
|
||||
dst_voices = 2;
|
||||
sparams.format.voices = dst_voices;
|
||||
swap_formats(params->channel, &src_voices, &dst_voices);
|
||||
err = snd_pcm_plugin_build_voices(params->format.format, src_voices,
|
||||
params->format.format, dst_voices,
|
||||
if (params->channel == SND_PCM_CHANNEL_PLAYBACK) {
|
||||
memcpy(&srcparams, params, sizeof(srcparams));
|
||||
memcpy(&tmpparams, params, sizeof(tmpparams));
|
||||
dstparams = &hwparams;
|
||||
} else {
|
||||
memcpy(&srcparams, &hwparams, sizeof(srcparams));
|
||||
memcpy(&tmpparams, &hwparams, sizeof(tmpparams));
|
||||
dstparams = params;
|
||||
}
|
||||
|
||||
/* Convert to interleaved format if needed */
|
||||
if (!srcparams.format.interleave &&
|
||||
(srcparams.format.voices != dstparams->format.voices ||
|
||||
(srcparams.format.rate != dstparams->format.rate &&
|
||||
srcparams.format.voices > 1))) {
|
||||
tmpparams.format.interleave = 1;
|
||||
err = snd_pcm_plugin_build_interleave(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
err = snd_pcm_plugin_append(pcm, params->channel, plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
srcparams.format.interleave = 1;
|
||||
/* Avoid useless interleave revert */
|
||||
if (params->channel == SND_PCM_CHANNEL_PLAYBACK &&
|
||||
(hwinfo.flags & SND_PCM_CHNINFO_INTERLEAVE))
|
||||
dstparams->format.interleave = 1;
|
||||
}
|
||||
|
||||
/* voices reduction */
|
||||
if (srcparams.format.voices > dstparams->format.voices) {
|
||||
tmpparams.format.voices = dstparams->format.voices;
|
||||
err = snd_pcm_plugin_build_voices(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
err = snd_pcm_plugin_append(pcm, params->channel, plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
srcparams.format.voices = dstparams->format.voices;
|
||||
}
|
||||
|
||||
/* format change */
|
||||
if (srcparams.format.format != dstparams->format.format) {
|
||||
switch (params->format.format) {
|
||||
case SND_PCM_SFMT_MU_LAW:
|
||||
err = snd_pcm_plugin_build_mulaw(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
break;
|
||||
case SND_PCM_SFMT_A_LAW:
|
||||
err = snd_pcm_plugin_build_alaw(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
break;
|
||||
case SND_PCM_SFMT_IMA_ADPCM:
|
||||
err = snd_pcm_plugin_build_adpcm(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
break;
|
||||
default:
|
||||
err = snd_pcm_plugin_build_linear(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
}
|
||||
if (err < 0)
|
||||
return err;
|
||||
err = snd_pcm_plugin_append(pcm, params->channel, plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
}
|
||||
|
||||
/* rate resampling */
|
||||
if (srcparams.format.rate != dstparams->format.rate) {
|
||||
tmpparams.format.rate = dstparams->format.rate;
|
||||
err = snd_pcm_plugin_build_rate(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
err = snd_pcm_plugin_append(pcm, params->channel, plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
srcparams.format.rate = dstparams->format.rate;
|
||||
}
|
||||
|
||||
/* voices extension */
|
||||
if (srcparams.format.voices < dstparams->format.voices) {
|
||||
tmpparams.format.voices = dstparams->format.voices;
|
||||
err = snd_pcm_plugin_build_voices(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
|
|
@ -439,64 +550,17 @@ int snd_pcm_plugin_params(snd_pcm_t *pcm, snd_pcm_channel_params_t *params)
|
|||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* formats
|
||||
*/
|
||||
|
||||
if (params->format.format == sparams.format.format)
|
||||
goto __format_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;
|
||||
case SND_PCM_SFMT_A_LAW:
|
||||
srcfmt = SND_PCM_SFMT_A_LAW;
|
||||
dstfmt = sparams.format.format;
|
||||
swap_formats(params->channel, &srcfmt, &dstfmt);
|
||||
err = snd_pcm_plugin_build_alaw(srcfmt, dstfmt, &plugin);
|
||||
break;
|
||||
case SND_PCM_SFMT_IMA_ADPCM:
|
||||
srcfmt = SND_PCM_SFMT_IMA_ADPCM;
|
||||
dstfmt = sparams.format.format;
|
||||
swap_formats(params->channel, &srcfmt, &dstfmt);
|
||||
err = snd_pcm_plugin_build_adpcm(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_append(pcm, params->channel, plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
srcparams.format.voices = dstparams->format.voices;
|
||||
}
|
||||
|
||||
__format_skip:
|
||||
|
||||
/*
|
||||
* rate
|
||||
*/
|
||||
|
||||
if (sparams.format.rate < sinfo.min_rate ||
|
||||
sparams.format.rate > sinfo.max_rate) {
|
||||
int src_rate = sparams.format.rate;
|
||||
int dst_rate = sparams.format.rate < sinfo.min_rate ?
|
||||
sinfo.min_rate : sinfo.max_rate;
|
||||
sparams.format.rate = dst_rate;
|
||||
swap_formats(params->channel, &src_rate, &dst_rate);
|
||||
err = snd_pcm_plugin_build_rate(sparams.format.format, src_rate, sparams.format.voices,
|
||||
sparams.format.format, dst_rate, sparams.format.voices,
|
||||
&plugin);
|
||||
/* interleave change */
|
||||
if (params->format.voices > 1 &&
|
||||
hwinfo.mode == SND_PCM_MODE_BLOCK &&
|
||||
srcparams.format.interleave != dstparams->format.interleave) {
|
||||
tmpparams.format.interleave = dstparams->format.interleave;
|
||||
err = snd_pcm_plugin_build_interleave(&srcparams.format,
|
||||
&tmpparams.format,
|
||||
&plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
|
|
@ -506,46 +570,17 @@ int snd_pcm_plugin_params(snd_pcm_t *pcm, snd_pcm_channel_params_t *params)
|
|||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* interleave
|
||||
*/
|
||||
|
||||
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_append(pcm, params->channel, plugin);
|
||||
if (err < 0) {
|
||||
snd_pcm_plugin_free(plugin);
|
||||
return err;
|
||||
}
|
||||
}
|
||||
srcparams.format.interleave = dstparams->format.interleave;
|
||||
}
|
||||
|
||||
/*
|
||||
* I/O plugins
|
||||
*/
|
||||
|
||||
if (sinfo.mode == SND_PCM_MODE_STREAM) {
|
||||
if (hwinfo.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) {
|
||||
} else if (hwinfo.mode == SND_PCM_MODE_BLOCK) {
|
||||
if (hwinfo.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);
|
||||
|
|
@ -561,25 +596,19 @@ int snd_pcm_plugin_params(snd_pcm_t *pcm, snd_pcm_channel_params_t *params)
|
|||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* ratio
|
||||
*/
|
||||
|
||||
ratio = snd_pcm_plugin_hardware_ratio(pcm, params->channel);
|
||||
if (ratio <= 0)
|
||||
return -EINVAL;
|
||||
/* compute right sizes */
|
||||
if (params->mode == SND_PCM_MODE_STREAM) {
|
||||
CONVERT_RATIO(sparams.buf.stream.queue_size, ratio);
|
||||
CONVERT_RATIO(sparams.buf.stream.max_fill, ratio);
|
||||
hwparams.buf.stream.queue_size = snd_pcm_plugin_hardware_size(pcm, hwparams.channel, hwparams.buf.stream.queue_size);
|
||||
hwparams.buf.stream.max_fill = snd_pcm_plugin_hardware_size(pcm, hwparams.channel, hwparams.buf.stream.max_fill);
|
||||
} else if (params->mode == SND_PCM_MODE_BLOCK) {
|
||||
CONVERT_RATIO(sparams.buf.block.frag_size, ratio);
|
||||
hwparams.buf.block.frag_size = snd_pcm_plugin_hardware_size(pcm, hwparams.channel, hwparams.buf.block.frag_size);
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
err = snd_pcm_channel_params(pcm, &sparams);
|
||||
err = snd_pcm_channel_params(pcm, &hwparams);
|
||||
if (err < 0)
|
||||
return err;
|
||||
err = snd_pcm_plugin_action(pcm, sparams.channel, INIT);
|
||||
err = snd_pcm_plugin_action(pcm, hwparams.channel, INIT);
|
||||
if (err < 0)
|
||||
return err;
|
||||
return 0;
|
||||
|
|
@ -587,7 +616,6 @@ int snd_pcm_plugin_params(snd_pcm_t *pcm, snd_pcm_channel_params_t *params)
|
|||
|
||||
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)
|
||||
|
|
@ -595,13 +623,10 @@ int snd_pcm_plugin_setup(snd_pcm_t *pcm, snd_pcm_channel_setup_t *setup)
|
|||
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);
|
||||
setup->buf.stream.queue_size = snd_pcm_plugin_transfer_size(pcm, setup->channel, setup->buf.stream.queue_size);
|
||||
} else if (setup->mode == SND_PCM_MODE_BLOCK) {
|
||||
CONVERT_RATIO(setup->buf.block.frag_size, ratio);
|
||||
setup->buf.block.frag_size = snd_pcm_plugin_transfer_size(pcm, setup->channel, setup->buf.block.frag_size);
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
|
@ -621,9 +646,9 @@ int snd_pcm_plugin_status(snd_pcm_t *pcm, snd_pcm_channel_status_t *status)
|
|||
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);
|
||||
status->scount = snd_pcm_plugin_transfer_size(pcm, status->channel, status->scount);
|
||||
status->count = snd_pcm_plugin_transfer_size(pcm, status->channel, status->count);
|
||||
status->free = snd_pcm_plugin_transfer_size(pcm, status->channel, status->free);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
|
@ -790,7 +815,7 @@ ssize_t snd_pcm_plugin_write(snd_pcm_t *pcm, const void *buffer, size_t count)
|
|||
}
|
||||
if (src_ptr1)
|
||||
snd_pcm_plugin_alloc_unlock(pcm, src_ptr1);
|
||||
plugin = plugin->next;
|
||||
plugin = next;
|
||||
src_ptr = dst_ptr;
|
||||
src_ptr1 = dst_ptr1;
|
||||
dst_ptr1 = NULL;
|
||||
|
|
|
|||
|
|
@ -1,7 +1,7 @@
|
|||
EXTRA_LTLIBRARIES = libpcmplugin.la
|
||||
|
||||
libpcmplugin_la_SOURCES = block.c mmap.c stream.c linear.c interleave.c \
|
||||
mulaw.c alaw.c adpcm.c rate.c voices.c
|
||||
mulaw.c alaw.c adpcm.c rate.c voices.c volbal.c
|
||||
all: libpcmplugin.la
|
||||
|
||||
|
||||
|
|
|
|||
|
|
@ -880,17 +880,25 @@ static ssize_t adpcm_dst_size(snd_pcm_plugin_t *plugin, size_t size)
|
|||
}
|
||||
}
|
||||
|
||||
int snd_pcm_plugin_build_adpcm(int src_format, int dst_format, snd_pcm_plugin_t **r_plugin)
|
||||
int snd_pcm_plugin_build_adpcm(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct adpcm_private_data *data;
|
||||
snd_pcm_plugin_t *plugin;
|
||||
combination_t cmd;
|
||||
|
||||
if (!r_plugin)
|
||||
if (!r_plugin || !src_format || !dst_format)
|
||||
return -EINVAL;
|
||||
*r_plugin = NULL;
|
||||
if (dst_format == SND_PCM_SFMT_IMA_ADPCM) {
|
||||
switch (src_format) {
|
||||
|
||||
if (src_format->interleave != dst_format->interleave ||
|
||||
src_format->voices != dst_format->voices ||
|
||||
src_format->rate != dst_format->rate)
|
||||
return -EINVAL;
|
||||
|
||||
if (dst_format->format == SND_PCM_SFMT_IMA_ADPCM) {
|
||||
switch (src_format->format) {
|
||||
case SND_PCM_SFMT_U8: cmd = _U8_ADPCM; break;
|
||||
case SND_PCM_SFMT_S8: cmd = _S8_ADPCM; break;
|
||||
case SND_PCM_SFMT_U16_LE: cmd = _U16LE_ADPCM; break;
|
||||
|
|
@ -900,8 +908,8 @@ int snd_pcm_plugin_build_adpcm(int src_format, int dst_format, snd_pcm_plugin_t
|
|||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
} else if (src_format == SND_PCM_SFMT_IMA_ADPCM) {
|
||||
switch (dst_format) {
|
||||
} else if (src_format->format == SND_PCM_SFMT_IMA_ADPCM) {
|
||||
switch (dst_format->format) {
|
||||
case SND_PCM_SFMT_U8: cmd = _ADPCM_U8; break;
|
||||
case SND_PCM_SFMT_S8: cmd = _ADPCM_S8; break;
|
||||
case SND_PCM_SFMT_U16_LE: cmd = _ADPCM_U16LE; break;
|
||||
|
|
|
|||
|
|
@ -414,7 +414,9 @@ static ssize_t alaw_dst_size(snd_pcm_plugin_t *plugin, size_t size)
|
|||
}
|
||||
}
|
||||
|
||||
int snd_pcm_plugin_build_alaw(int src_format, int dst_format, snd_pcm_plugin_t **r_plugin)
|
||||
int snd_pcm_plugin_build_alaw(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct alaw_private_data *data;
|
||||
snd_pcm_plugin_t *plugin;
|
||||
|
|
@ -423,8 +425,16 @@ int snd_pcm_plugin_build_alaw(int src_format, int dst_format, snd_pcm_plugin_t *
|
|||
if (!r_plugin)
|
||||
return -EINVAL;
|
||||
*r_plugin = NULL;
|
||||
if (dst_format == SND_PCM_SFMT_A_LAW) {
|
||||
switch (src_format) {
|
||||
|
||||
if (src_format->interleave != dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (src_format->rate != dst_format->rate)
|
||||
return -EINVAL;
|
||||
if (src_format->voices != dst_format->voices)
|
||||
return -EINVAL;
|
||||
|
||||
if (dst_format->format == SND_PCM_SFMT_A_LAW) {
|
||||
switch (src_format->format) {
|
||||
case SND_PCM_SFMT_U8: cmd = _U8_ALAW; break;
|
||||
case SND_PCM_SFMT_S8: cmd = _S8_ALAW; break;
|
||||
case SND_PCM_SFMT_U16_LE: cmd = _U16LE_ALAW; break;
|
||||
|
|
@ -434,8 +444,8 @@ int snd_pcm_plugin_build_alaw(int src_format, int dst_format, snd_pcm_plugin_t *
|
|||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
} else if (src_format == SND_PCM_SFMT_A_LAW) {
|
||||
switch (dst_format) {
|
||||
} else if (src_format->format == SND_PCM_SFMT_A_LAW) {
|
||||
switch (dst_format->format) {
|
||||
case SND_PCM_SFMT_U8: cmd = _ALAW_U8; break;
|
||||
case SND_PCM_SFMT_S8: cmd = _ALAW_S8; break;
|
||||
case SND_PCM_SFMT_U16_LE: cmd = _ALAW_U16LE; break;
|
||||
|
|
|
|||
|
|
@ -177,7 +177,9 @@ static ssize_t interleave_transfer(snd_pcm_plugin_t *plugin,
|
|||
return src_size;
|
||||
}
|
||||
|
||||
int snd_pcm_plugin_build_interleave(int src_interleave, int dst_interleave, int format, snd_pcm_plugin_t **r_plugin)
|
||||
int snd_pcm_plugin_build_interleave(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct interleave_private_data *data;
|
||||
snd_pcm_plugin_t *plugin;
|
||||
|
|
@ -186,14 +188,21 @@ int snd_pcm_plugin_build_interleave(int src_interleave, int dst_interleave, int
|
|||
|
||||
if (!r_plugin)
|
||||
return -EINVAL;
|
||||
if (src_interleave && !dst_interleave) {
|
||||
if (src_format->interleave && !dst_format->interleave) {
|
||||
cmd = _INTERLEAVE_NON;
|
||||
} else if (!src_interleave && dst_interleave) {
|
||||
} else if (!src_format->interleave && dst_format->interleave) {
|
||||
cmd = _NON_INTERLEAVE;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
switch (format) {
|
||||
if (src_format->format != dst_format->format)
|
||||
return -EINVAL;
|
||||
if (src_format->rate != dst_format->rate)
|
||||
return -EINVAL;
|
||||
if (src_format->voices != dst_format->voices)
|
||||
return -EINVAL;
|
||||
|
||||
switch (dst_format->format) {
|
||||
case SND_PCM_SFMT_S8:
|
||||
case SND_PCM_SFMT_U8: size = 1; break;
|
||||
case SND_PCM_SFMT_S16_LE:
|
||||
|
|
|
|||
|
|
@ -310,7 +310,9 @@ static int linear_sign(int format)
|
|||
}
|
||||
}
|
||||
|
||||
int snd_pcm_plugin_build_linear(int src_format, int dst_format, snd_pcm_plugin_t **r_plugin)
|
||||
int snd_pcm_plugin_build_linear(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct linear_private_data *data;
|
||||
snd_pcm_plugin_t *plugin;
|
||||
|
|
@ -320,12 +322,20 @@ int snd_pcm_plugin_build_linear(int src_format, int dst_format, snd_pcm_plugin_t
|
|||
if (!r_plugin)
|
||||
return -EINVAL;
|
||||
*r_plugin = NULL;
|
||||
wide1 = linear_wide(src_format);
|
||||
endian1 = linear_endian(src_format);
|
||||
sign1 = linear_sign(src_format);
|
||||
wide2 = linear_wide(dst_format);
|
||||
endian2 = linear_endian(dst_format);
|
||||
sign2 = linear_sign(dst_format);
|
||||
|
||||
if (src_format->interleave != dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (src_format->rate != dst_format->rate)
|
||||
return -EINVAL;
|
||||
if (src_format->voices != dst_format->voices)
|
||||
return -EINVAL;
|
||||
|
||||
wide1 = linear_wide(src_format->format);
|
||||
endian1 = linear_endian(src_format->format);
|
||||
sign1 = linear_sign(src_format->format);
|
||||
wide2 = linear_wide(dst_format->format);
|
||||
endian2 = linear_endian(dst_format->format);
|
||||
sign2 = linear_sign(dst_format->format);
|
||||
if (wide1 < 0 || wide2 < 0 || endian1 < 0 || endian2 < 0 || sign1 < 0 || sign2 < 0)
|
||||
return -EINVAL;
|
||||
#if __BYTE_ORDER == __LITTLE_ENDIAN
|
||||
|
|
|
|||
|
|
@ -424,7 +424,9 @@ static ssize_t mulaw_dst_size(snd_pcm_plugin_t *plugin, size_t size)
|
|||
}
|
||||
}
|
||||
|
||||
int snd_pcm_plugin_build_mulaw(int src_format, int dst_format, snd_pcm_plugin_t **r_plugin)
|
||||
int snd_pcm_plugin_build_mulaw(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct mulaw_private_data *data;
|
||||
snd_pcm_plugin_t *plugin;
|
||||
|
|
@ -433,8 +435,16 @@ int snd_pcm_plugin_build_mulaw(int src_format, int dst_format, snd_pcm_plugin_t
|
|||
if (!r_plugin)
|
||||
return -EINVAL;
|
||||
*r_plugin = NULL;
|
||||
if (dst_format == SND_PCM_SFMT_MU_LAW) {
|
||||
switch (src_format) {
|
||||
|
||||
if (src_format->interleave != dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (src_format->rate != dst_format->rate)
|
||||
return -EINVAL;
|
||||
if (src_format->voices != dst_format->voices)
|
||||
return -EINVAL;
|
||||
|
||||
if (dst_format->format == SND_PCM_SFMT_MU_LAW) {
|
||||
switch (src_format->format) {
|
||||
case SND_PCM_SFMT_U8: cmd = _U8_MULAW; break;
|
||||
case SND_PCM_SFMT_S8: cmd = _S8_MULAW; break;
|
||||
case SND_PCM_SFMT_U16_LE: cmd = _U16LE_MULAW; break;
|
||||
|
|
@ -444,8 +454,8 @@ int snd_pcm_plugin_build_mulaw(int src_format, int dst_format, snd_pcm_plugin_t
|
|||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
} else if (src_format == SND_PCM_SFMT_MU_LAW) {
|
||||
switch (dst_format) {
|
||||
} else if (src_format->format == SND_PCM_SFMT_MU_LAW) {
|
||||
switch (dst_format->format) {
|
||||
case SND_PCM_SFMT_U8: cmd = _MULAW_U8; break;
|
||||
case SND_PCM_SFMT_S8: cmd = _MULAW_S8; break;
|
||||
case SND_PCM_SFMT_U16_LE: cmd = _MULAW_U16LE; break;
|
||||
|
|
|
|||
|
|
@ -48,6 +48,43 @@ struct rate_private_data {
|
|||
ssize_t old_src_size, old_dst_size;
|
||||
};
|
||||
|
||||
static void mix_mono(struct rate_private_data *data,
|
||||
signed short *src_ptr, int src_size,
|
||||
signed short *dst_ptr, int dst_size)
|
||||
{
|
||||
unsigned int pos;
|
||||
signed int val;
|
||||
signed int L_S1, L_S2;
|
||||
|
||||
pos = data->pos;
|
||||
L_S1 = data->last_L_S1;
|
||||
L_S2 = data->last_L_S2;
|
||||
if (pos >> SHIFT) {
|
||||
src_ptr += ((pos >> SHIFT) - 1); pos &= MASK;
|
||||
L_S1 = L_S2;
|
||||
L_S2 = *src_ptr;
|
||||
}
|
||||
while (dst_size-- > 0) {
|
||||
if (pos >> SHIFT) {
|
||||
src_ptr += (pos >> SHIFT); pos &= MASK;
|
||||
L_S1 = L_S2;
|
||||
L_S2 = *src_ptr;
|
||||
}
|
||||
|
||||
val = L_S1 + ((L_S2 - L_S1) * (signed int)pos) / BITS;
|
||||
if (val < -32768)
|
||||
val = -32768;
|
||||
else if (val > 32767)
|
||||
val = 32767;
|
||||
*dst_ptr++ = val;
|
||||
|
||||
pos += data->pitch;
|
||||
}
|
||||
data->last_L_S1 = L_S1;
|
||||
data->last_L_S2 = L_S2;
|
||||
data->pos = pos;
|
||||
}
|
||||
|
||||
static void mix_stereo(struct rate_private_data *data,
|
||||
signed short *src_ptr, int src_size,
|
||||
signed short *dst_ptr, int dst_size)
|
||||
|
|
@ -115,7 +152,12 @@ static ssize_t rate_transfer(snd_pcm_plugin_t *plugin,
|
|||
data = (struct rate_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
if (data == NULL)
|
||||
return -EINVAL;
|
||||
if (data->src_voices == 2) {
|
||||
if (data->src_voices == 1) {
|
||||
mix_mono(data, (signed short *)src_ptr, src_size / 2,
|
||||
(signed short *)dst_ptr, dst_size / 2);
|
||||
return (dst_size / 2) * 2;
|
||||
}
|
||||
else if (data->src_voices == 2) {
|
||||
mix_stereo(data, (signed short *)src_ptr, src_size / 4,
|
||||
(signed short *)dst_ptr, dst_size / 4);
|
||||
return (dst_size / 4) * 4;
|
||||
|
|
@ -152,7 +194,9 @@ static ssize_t rate_src_size(snd_pcm_plugin_t *plugin, size_t size)
|
|||
if (!plugin || size <= 0)
|
||||
return -EINVAL;
|
||||
data = (struct rate_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
res = (((size * data->pitch) + (BITS/2)) >> SHIFT) & ~3;
|
||||
res = (((size * data->pitch) + (BITS/2)) >> SHIFT);
|
||||
res = res / (data->src_voices*2) * (data->src_voices*2);
|
||||
/* Why this? */
|
||||
if (size < 128*1024) {
|
||||
if (data->old_src_size == size)
|
||||
return data->old_dst_size;
|
||||
|
|
@ -170,7 +214,9 @@ static ssize_t rate_dst_size(snd_pcm_plugin_t *plugin, size_t size)
|
|||
if (!plugin || size <= 0)
|
||||
return -EINVAL;
|
||||
data = (struct rate_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
res = (((size << SHIFT) + (data->pitch / 2)) / data->pitch) & ~3;
|
||||
res = (((size << SHIFT) + (data->pitch / 2)) / data->pitch);
|
||||
res = res / (data->src_voices*2) * (data->src_voices*2);
|
||||
/* Why this? */
|
||||
if (size < 128*1024) {
|
||||
if (data->old_dst_size == size)
|
||||
return data->old_src_size;
|
||||
|
|
@ -180,8 +226,8 @@ static ssize_t rate_dst_size(snd_pcm_plugin_t *plugin, size_t size)
|
|||
return res;
|
||||
}
|
||||
|
||||
int snd_pcm_plugin_build_rate(int src_format, int src_rate, int src_voices,
|
||||
int dst_format, int dst_rate, int dst_voices,
|
||||
int snd_pcm_plugin_build_rate(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct rate_private_data *data;
|
||||
|
|
@ -190,23 +236,33 @@ int snd_pcm_plugin_build_rate(int src_format, int src_rate, int src_voices,
|
|||
if (!r_plugin)
|
||||
return -EINVAL;
|
||||
*r_plugin = NULL;
|
||||
if (src_voices != 2 || dst_voices != 2)
|
||||
|
||||
if (src_format->interleave != dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (src_format != SND_PCM_SFMT_S16_LE ||
|
||||
dst_format != SND_PCM_SFMT_S16_LE)
|
||||
if (src_format->format != dst_format->format)
|
||||
return -EINVAL;
|
||||
if (src_rate == dst_rate)
|
||||
if (!dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (src_format->voices != dst_format->voices)
|
||||
return -EINVAL;
|
||||
if (dst_format->voices != 1 && dst_format->voices != 2)
|
||||
return -EINVAL;
|
||||
|
||||
if (src_format->format != SND_PCM_SFMT_S16_LE ||
|
||||
dst_format->format != SND_PCM_SFMT_S16_LE)
|
||||
return -EINVAL;
|
||||
if (src_format->rate == dst_format->rate)
|
||||
return -EINVAL;
|
||||
plugin = snd_pcm_plugin_build("rate format conversion",
|
||||
sizeof(struct rate_private_data));
|
||||
if (plugin == NULL)
|
||||
return -ENOMEM;
|
||||
data = (struct rate_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
data->src_voices = src_voices;
|
||||
data->dst_voices = dst_voices;
|
||||
data->src_rate = src_rate;
|
||||
data->dst_rate = dst_rate;
|
||||
data->pitch = ((src_rate << SHIFT) + (dst_rate >> 1)) / dst_rate;
|
||||
data->src_voices = src_format->voices;
|
||||
data->dst_voices = dst_format->voices;
|
||||
data->src_rate = src_format->rate;
|
||||
data->dst_rate = dst_format->rate;
|
||||
data->pitch = ((src_format->rate << SHIFT) + (dst_format->rate >> 1)) / dst_format->rate;
|
||||
data->pos = 0;
|
||||
data->last_L_S1 = data->last_R_S1 = 0;
|
||||
data->last_L_S2 = data->last_R_S2 = 0;
|
||||
|
|
|
|||
|
|
@ -168,8 +168,8 @@ static ssize_t voices_dst_size(snd_pcm_plugin_t *plugin, size_t size)
|
|||
return (size * data->dst_voices) / data->src_voices;
|
||||
}
|
||||
|
||||
int snd_pcm_plugin_build_voices(int src_format, int src_voices,
|
||||
int dst_format, int dst_voices,
|
||||
int snd_pcm_plugin_build_voices(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct voices_private_data *data;
|
||||
|
|
@ -178,15 +178,22 @@ int snd_pcm_plugin_build_voices(int src_format, int src_voices,
|
|||
if (!r_plugin)
|
||||
return -EINVAL;
|
||||
*r_plugin = NULL;
|
||||
if (src_voices == dst_voices)
|
||||
|
||||
if (src_format->interleave != dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (src_voices < 1 || src_voices > 2 ||
|
||||
dst_voices < 1 || dst_voices > 2)
|
||||
if (!dst_format->interleave)
|
||||
return -EINVAL;
|
||||
if (src_format != dst_format)
|
||||
if (src_format->format != dst_format->format)
|
||||
return -EINVAL;
|
||||
if (src_format < SND_PCM_SFMT_S8 || src_format > SND_PCM_SFMT_U16_BE) {
|
||||
if (src_format != SND_PCM_SFMT_MU_LAW && src_format != SND_PCM_SFMT_A_LAW)
|
||||
if (src_format->rate != dst_format->rate)
|
||||
return -EINVAL;
|
||||
if (src_format->voices == dst_format->voices)
|
||||
return -EINVAL;
|
||||
if (src_format->voices < 1 || src_format->voices > 2 ||
|
||||
dst_format->voices < 1 || dst_format->voices > 2)
|
||||
return -EINVAL;
|
||||
if (src_format->format < SND_PCM_SFMT_S8 || src_format->format > SND_PCM_SFMT_U16_BE) {
|
||||
if (src_format->format != SND_PCM_SFMT_MU_LAW && src_format->format != SND_PCM_SFMT_A_LAW)
|
||||
return -EINVAL;
|
||||
}
|
||||
plugin = snd_pcm_plugin_build("voices conversion",
|
||||
|
|
@ -194,11 +201,11 @@ int snd_pcm_plugin_build_voices(int src_format, int src_voices,
|
|||
if (plugin == NULL)
|
||||
return -ENOMEM;
|
||||
data = (struct voices_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
data->src_voices = src_voices;
|
||||
data->dst_voices = dst_voices;
|
||||
data->width = snd_pcm_format_width(src_format);
|
||||
data->flg_merge = src_voices > dst_voices;
|
||||
data->flg_signed = snd_pcm_format_signed(src_format);
|
||||
data->src_voices = src_format->voices;
|
||||
data->dst_voices = dst_format->voices;
|
||||
data->width = snd_pcm_format_width(src_format->format);
|
||||
data->flg_merge = src_format->voices > dst_format->voices;
|
||||
data->flg_signed = snd_pcm_format_signed(src_format->format);
|
||||
plugin->transfer = voices_transfer;
|
||||
plugin->src_size = voices_src_size;
|
||||
plugin->dst_size = voices_dst_size;
|
||||
|
|
|
|||
171
src/pcm/plugin/volbal.c
Normal file
171
src/pcm/plugin/volbal.c
Normal file
|
|
@ -0,0 +1,171 @@
|
|||
/*
|
||||
* Volume and balance Plug-In
|
||||
* Copyright (c) 1999 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.
|
||||
*
|
||||
*/
|
||||
|
||||
#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"
|
||||
|
||||
|
||||
#define VOLBAL_RESOLUTION 16
|
||||
|
||||
struct volbal_private_data {
|
||||
int src_voices;
|
||||
int noop;
|
||||
int ttable[0];
|
||||
};
|
||||
|
||||
static void volbal(int voices, int samples, int *ttable,
|
||||
signed short *src_ptr, signed short *dst_ptr)
|
||||
{
|
||||
while (samples-- > 0) {
|
||||
int dst_voice;
|
||||
int *t = ttable;
|
||||
for (dst_voice = 0; dst_voice < voices; ++dst_voice) {
|
||||
int v = 0;
|
||||
int src_voice;
|
||||
signed short *s = src_ptr;
|
||||
for (src_voice = 0; src_voice < voices; ++src_voice) {
|
||||
v += *s++ * *t++ / VOLBAL_RESOLUTION;
|
||||
}
|
||||
*dst_ptr++ = v;
|
||||
src_ptr += voices;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static ssize_t volbal_transfer(snd_pcm_plugin_t *plugin,
|
||||
char *src_ptr, size_t src_size,
|
||||
char *dst_ptr, size_t dst_size)
|
||||
{
|
||||
struct volbal_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 volbal_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
if (data == NULL)
|
||||
return -EINVAL;
|
||||
if (data->noop)
|
||||
return 0;
|
||||
|
||||
volbal(data->src_voices, src_size / 2 / data->src_voices, data->ttable,
|
||||
(signed short *)src_ptr, (signed short *)dst_ptr);
|
||||
return src_size;
|
||||
}
|
||||
|
||||
static ssize_t volbal_src_size(snd_pcm_plugin_t *plugin, size_t size)
|
||||
{
|
||||
if (!plugin || size <= 0)
|
||||
return -EINVAL;
|
||||
return size;
|
||||
}
|
||||
|
||||
static ssize_t volbal_dst_size(snd_pcm_plugin_t *plugin, size_t size)
|
||||
{
|
||||
if (!plugin || size <= 0)
|
||||
return -EINVAL;
|
||||
return size;
|
||||
}
|
||||
|
||||
|
||||
static int volbal_load_ttable(struct volbal_private_data *data,
|
||||
const int *src_ttable)
|
||||
{
|
||||
int src_voice, dst_voice;
|
||||
const int *sptr;
|
||||
int *dptr;
|
||||
data->noop = 1;
|
||||
if (src_ttable == NULL)
|
||||
return 0;
|
||||
sptr = src_ttable;
|
||||
dptr = data->ttable;
|
||||
for (dst_voice = 0; dst_voice < data->src_voices; ++dst_voice) {
|
||||
int t = 0;
|
||||
for (src_voice = 0; src_voice < data->src_voices; ++src_voice) {
|
||||
if (*sptr < 0 || *sptr > VOLBAL_RESOLUTION)
|
||||
return -EINVAL;
|
||||
if (src_voice == dst_voice) {
|
||||
if (*sptr != VOLBAL_RESOLUTION)
|
||||
data->noop = 0;
|
||||
}
|
||||
else {
|
||||
if (*sptr != 0)
|
||||
data->noop = 0;
|
||||
}
|
||||
t += *sptr;
|
||||
*dptr++ = *sptr++;
|
||||
}
|
||||
if (t > VOLBAL_RESOLUTION)
|
||||
return -EINVAL;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
int snd_pcm_plugin_build_volbal(snd_pcm_format_t *src_format,
|
||||
snd_pcm_format_t *dst_format,
|
||||
int *ttable,
|
||||
snd_pcm_plugin_t **r_plugin)
|
||||
{
|
||||
struct volbal_private_data *data;
|
||||
snd_pcm_plugin_t *plugin;
|
||||
int res;
|
||||
|
||||
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 (src_format->rate != dst_format->rate)
|
||||
return -EINVAL;
|
||||
if (src_format->voices != dst_format->voices)
|
||||
return -EINVAL;
|
||||
|
||||
if (src_format->voices < 1)
|
||||
return -EINVAL;
|
||||
if (src_format->format != SND_PCM_SFMT_S16_LE)
|
||||
return -EINVAL;
|
||||
plugin = snd_pcm_plugin_build("Volume/balance conversion",
|
||||
sizeof(struct volbal_private_data) +
|
||||
sizeof(data->ttable[0]) * src_format->voices * src_format->voices);
|
||||
if (plugin == NULL)
|
||||
return -ENOMEM;
|
||||
data = (struct volbal_private_data *)snd_pcm_plugin_extra_data(plugin);
|
||||
data->src_voices = src_format->voices;
|
||||
if ((res = volbal_load_ttable(data, ttable)) < 0)
|
||||
return res;
|
||||
|
||||
plugin->transfer = volbal_transfer;
|
||||
plugin->src_size = volbal_src_size;
|
||||
plugin->dst_size = volbal_dst_size;
|
||||
*r_plugin = plugin;
|
||||
return 0;
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue