|
Packit Service |
cd2a00 |
/*
|
|
Packit Service |
cd2a00 |
* Rate converter plugin using libavresample
|
|
Packit Service |
cd2a00 |
* Copyright (c) 2014 by Anton Khirnov
|
|
Packit Service |
cd2a00 |
*
|
|
Packit Service |
cd2a00 |
* This library is free software; you can redistribute it and/or
|
|
Packit Service |
cd2a00 |
* modify it under the terms of the GNU Lesser General Public
|
|
Packit Service |
cd2a00 |
* License as published by the Free Software Foundation; either
|
|
Packit Service |
cd2a00 |
* version 2.1 of the License, or (at your option) any later version.
|
|
Packit Service |
cd2a00 |
*
|
|
Packit Service |
cd2a00 |
* This library is distributed in the hope that it will be useful,
|
|
Packit Service |
cd2a00 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit Service |
cd2a00 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Packit Service |
cd2a00 |
* Lesser General Public License for more details.
|
|
Packit Service |
cd2a00 |
*/
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
#include <stdio.h>
|
|
Packit Service |
cd2a00 |
#include <alsa/asoundlib.h>
|
|
Packit Service |
cd2a00 |
#include <alsa/pcm_rate.h>
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
#include <libavresample/avresample.h>
|
|
Packit Service |
cd2a00 |
#include <libavutil/channel_layout.h>
|
|
Packit Service |
cd2a00 |
#include <libavutil/opt.h>
|
|
Packit Service |
cd2a00 |
#include <libavutil/mathematics.h>
|
|
Packit Service |
cd2a00 |
#include <libavutil/samplefmt.h>
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static unsigned int filter_size = 16;
|
|
Packit Service |
cd2a00 |
static unsigned int phase_shift = 10; /* auto-adjusts */
|
|
Packit Service |
cd2a00 |
static double cutoff = 0; /* auto-adjusts */
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
struct rate_src {
|
|
Packit Service |
cd2a00 |
AVAudioResampleContext *avr;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
unsigned int in_rate;
|
|
Packit Service |
cd2a00 |
unsigned int out_rate;
|
|
Packit Service |
cd2a00 |
unsigned int channels;
|
|
Packit Service |
cd2a00 |
};
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static snd_pcm_uframes_t input_frames(void *obj ATTRIBUTE_UNUSED,
|
|
Packit Service |
cd2a00 |
snd_pcm_uframes_t frames)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
return frames;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static snd_pcm_uframes_t output_frames(void *obj ATTRIBUTE_UNUSED,
|
|
Packit Service |
cd2a00 |
snd_pcm_uframes_t frames)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
return frames;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static void pcm_src_free(void *obj)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
struct rate_src *rate = obj;
|
|
Packit Service |
cd2a00 |
avresample_free(&rate->avr);
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static int pcm_src_init(void *obj, snd_pcm_rate_info_t *info)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
struct rate_src *rate = obj;
|
|
Packit Service |
cd2a00 |
int i, ir, or;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
if (!rate->avr || rate->channels != info->channels) {
|
|
Packit Service |
cd2a00 |
int ret;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
pcm_src_free(rate);
|
|
Packit Service |
cd2a00 |
rate->channels = info->channels;
|
|
Packit Service |
cd2a00 |
ir = rate->in_rate = info->in.rate;
|
|
Packit Service |
cd2a00 |
or = rate->out_rate = info->out.rate;
|
|
Packit Service |
cd2a00 |
i = av_gcd(or, ir);
|
|
Packit Service |
cd2a00 |
if (or > ir) {
|
|
Packit Service |
cd2a00 |
phase_shift = or/i;
|
|
Packit Service |
cd2a00 |
} else {
|
|
Packit Service |
cd2a00 |
phase_shift = ir/i;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
if (cutoff <= 0.0) {
|
|
Packit Service |
cd2a00 |
cutoff = 1.0 - 1.0/filter_size;
|
|
Packit Service |
cd2a00 |
if (cutoff < 0.80)
|
|
Packit Service |
cd2a00 |
cutoff = 0.80;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
rate->avr = avresample_alloc_context();
|
|
Packit Service |
cd2a00 |
if (!rate->avr)
|
|
Packit Service |
cd2a00 |
return -ENOMEM;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
av_opt_set_int(rate->avr, "in_sample_rate", info->in.rate, 0);
|
|
Packit Service |
cd2a00 |
av_opt_set_int(rate->avr, "out_sample_rate", info->out.rate, 0);
|
|
Packit Service |
cd2a00 |
av_opt_set_int(rate->avr, "in_sample_format", AV_SAMPLE_FMT_S16, 0);
|
|
Packit Service |
cd2a00 |
av_opt_set_int(rate->avr, "out_sample_format", AV_SAMPLE_FMT_S16, 0);
|
|
Packit Service |
cd2a00 |
av_opt_set_int(rate->avr, "in_channel_layout", av_get_default_channel_layout(rate->channels), 0);
|
|
Packit Service |
cd2a00 |
av_opt_set_int(rate->avr, "out_channel_layout", av_get_default_channel_layout(rate->channels), 0);
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
av_opt_set_int(rate->avr, "filter_size", filter_size, 0);
|
|
Packit Service |
cd2a00 |
av_opt_set_int(rate->avr, "phase_shift", phase_shift, 0);
|
|
Packit Service |
cd2a00 |
av_opt_set_double(rate->avr, "cutoff", cutoff, 0);
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
ret = avresample_open(rate->avr);
|
|
Packit Service |
cd2a00 |
if (ret < 0) {
|
|
Packit Service |
cd2a00 |
avresample_free(&rate->avr);
|
|
Packit Service |
cd2a00 |
return -EINVAL;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
return 0;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static int pcm_src_adjust_pitch(void *obj, snd_pcm_rate_info_t *info)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
struct rate_src *rate = obj;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
if (info->out.rate != rate->out_rate || info->in.rate != rate->in_rate)
|
|
Packit Service |
cd2a00 |
pcm_src_init(obj, info);
|
|
Packit Service |
cd2a00 |
return 0;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static void pcm_src_reset(void *obj)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
struct rate_src *rate = obj;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
if (rate->avr) {
|
|
Packit Service |
cd2a00 |
#if 0
|
|
Packit Service |
cd2a00 |
avresample_close(rate->avr);
|
|
Packit Service |
cd2a00 |
avresample_open(rate->avr);
|
|
Packit Service |
cd2a00 |
#endif
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static void pcm_src_convert_s16(void *obj, int16_t *dst,
|
|
Packit Service |
cd2a00 |
unsigned int dst_frames,
|
|
Packit Service |
cd2a00 |
const int16_t *src,
|
|
Packit Service |
cd2a00 |
unsigned int src_frames)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
struct rate_src *rate = obj;
|
|
Packit Service |
cd2a00 |
int chans = rate->channels;
|
|
Packit Service |
cd2a00 |
unsigned int total_in = avresample_get_delay(rate->avr) + src_frames;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
avresample_convert(rate->avr, (uint8_t **)&dst, dst_frames * chans * 2, dst_frames,
|
|
Packit Service |
cd2a00 |
(uint8_t **)&src, src_frames * chans * 2, src_frames);
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
avresample_set_compensation(rate->avr,
|
|
Packit Service |
cd2a00 |
total_in - src_frames > filter_size ? 0 : 1, src_frames);
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static void pcm_src_close(void *obj)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
pcm_src_free(obj);
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
#if SND_PCM_RATE_PLUGIN_VERSION >= 0x010002
|
|
Packit Service |
cd2a00 |
static int get_supported_rates(void *obj ATTRIBUTE_UNUSED,
|
|
Packit Service |
cd2a00 |
unsigned int *rate_min,
|
|
Packit Service |
cd2a00 |
unsigned int *rate_max)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
*rate_min = *rate_max = 0; /* both unlimited */
|
|
Packit Service |
cd2a00 |
return 0;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static void dump(void *obj ATTRIBUTE_UNUSED, snd_output_t *out)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
snd_output_printf(out, "Converter: libavr\n");
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
#endif
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
static snd_pcm_rate_ops_t pcm_src_ops = {
|
|
Packit Service |
cd2a00 |
.close = pcm_src_close,
|
|
Packit Service |
cd2a00 |
.init = pcm_src_init,
|
|
Packit Service |
cd2a00 |
.free = pcm_src_free,
|
|
Packit Service |
cd2a00 |
.reset = pcm_src_reset,
|
|
Packit Service |
cd2a00 |
.adjust_pitch = pcm_src_adjust_pitch,
|
|
Packit Service |
cd2a00 |
.convert_s16 = pcm_src_convert_s16,
|
|
Packit Service |
cd2a00 |
.input_frames = input_frames,
|
|
Packit Service |
cd2a00 |
.output_frames = output_frames,
|
|
Packit Service |
cd2a00 |
#if SND_PCM_RATE_PLUGIN_VERSION >= 0x010002
|
|
Packit Service |
cd2a00 |
.version = SND_PCM_RATE_PLUGIN_VERSION,
|
|
Packit Service |
cd2a00 |
.get_supported_rates = get_supported_rates,
|
|
Packit Service |
cd2a00 |
.dump = dump,
|
|
Packit Service |
cd2a00 |
#endif
|
|
Packit Service |
cd2a00 |
};
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
int pcm_src_open(unsigned int version, void **objp, snd_pcm_rate_ops_t *ops)
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
struct rate_src *rate;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
#if SND_PCM_RATE_PLUGIN_VERSION < 0x010002
|
|
Packit Service |
cd2a00 |
if (version != SND_PCM_RATE_PLUGIN_VERSION) {
|
|
Packit Service |
cd2a00 |
fprintf(stderr, "Invalid rate plugin version %x\n", version);
|
|
Packit Service |
cd2a00 |
return -EINVAL;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
#endif
|
|
Packit Service |
cd2a00 |
rate = calloc(1, sizeof(*rate));
|
|
Packit Service |
cd2a00 |
if (!rate)
|
|
Packit Service |
cd2a00 |
return -ENOMEM;
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
*objp = rate;
|
|
Packit Service |
cd2a00 |
rate->avr = NULL;
|
|
Packit Service |
cd2a00 |
#if SND_PCM_RATE_PLUGIN_VERSION >= 0x010002
|
|
Packit Service |
cd2a00 |
if (version == 0x010001)
|
|
Packit Service |
cd2a00 |
memcpy(ops, &pcm_src_ops, sizeof(snd_pcm_rate_old_ops_t));
|
|
Packit Service |
cd2a00 |
else
|
|
Packit Service |
cd2a00 |
#endif
|
|
Packit Service |
cd2a00 |
*ops = pcm_src_ops;
|
|
Packit Service |
cd2a00 |
return 0;
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
int SND_PCM_RATE_PLUGIN_ENTRY(lavrate)(unsigned int version, void **objp,
|
|
Packit Service |
cd2a00 |
snd_pcm_rate_ops_t *ops)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
return pcm_src_open(version, objp, ops);
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
int SND_PCM_RATE_PLUGIN_ENTRY(lavrate_higher)(unsigned int version,
|
|
Packit Service |
cd2a00 |
void **objp, snd_pcm_rate_ops_t *ops)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
filter_size = 64;
|
|
Packit Service |
cd2a00 |
return pcm_src_open(version, objp, ops);
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
int SND_PCM_RATE_PLUGIN_ENTRY(lavrate_high)(unsigned int version,
|
|
Packit Service |
cd2a00 |
void **objp, snd_pcm_rate_ops_t *ops)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
filter_size = 32;
|
|
Packit Service |
cd2a00 |
return pcm_src_open(version, objp, ops);
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
int SND_PCM_RATE_PLUGIN_ENTRY(lavrate_fast)(unsigned int version,
|
|
Packit Service |
cd2a00 |
void **objp, snd_pcm_rate_ops_t *ops)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
filter_size = 8;
|
|
Packit Service |
cd2a00 |
return pcm_src_open(version, objp, ops);
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
int SND_PCM_RATE_PLUGIN_ENTRY(lavrate_faster)(unsigned int version,
|
|
Packit Service |
cd2a00 |
void **objp, snd_pcm_rate_ops_t *ops)
|
|
Packit Service |
cd2a00 |
{
|
|
Packit Service |
cd2a00 |
filter_size = 4;
|
|
Packit Service |
cd2a00 |
return pcm_src_open(version, objp, ops);
|
|
Packit Service |
cd2a00 |
}
|
|
Packit Service |
cd2a00 |
|
|
Packit Service |
cd2a00 |
|