3948afb03b224571efedd14c3fba5fdc83a50915
[vlc.git] / modules / audio_filter / resampler / speex.c
1 /*****************************************************************************
2  * speex.c : libspeex DSP resampler
3  *****************************************************************************
4  * Copyright © 2011 Rémi Denis-Courmont
5  *
6  * This program is free software; you can redistribute it and/or modify it
7  * under the terms of the GNU Lesser General Public License as published by
8  * the Free Software Foundation; either version 2.1 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public License
17  * along with this program; if not, write to the Free Software Foundation,
18  * Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
19  *****************************************************************************/
20
21 #ifdef HAVE_CONFIG_H
22 # include <config.h>
23 #endif
24
25 #include <vlc_common.h>
26 #include <vlc_aout.h>
27 #include <vlc_filter.h>
28 #include <vlc_plugin.h>
29
30 #include <speex/speex_resampler.h>
31
32 #define QUALITY_TEXT N_("Resampling quality")
33 #define QUALITY_LONGTEXT N_( \
34     "Resampling quality (0 = worst and fastest, 10 = best and slowest).")
35
36 static int Open (vlc_object_t *);
37 static void Close (vlc_object_t *);
38
39 vlc_module_begin ()
40     set_shortname (N_("Speex resampler"))
41     set_description (N_("Speex resampler") )
42     set_category (CAT_AUDIO)
43     set_subcategory (SUBCAT_AUDIO_MISC)
44     add_integer ("speex-resampler-quality", 4,
45                  QUALITY_TEXT, QUALITY_LONGTEXT, true)
46         change_integer_range (0, 10)
47     set_capability ("audio filter", 60)
48     set_callbacks (Open, Close)
49
50     add_submodule ()
51     set_capability ("audio resampler", 60)
52     set_callbacks (Open, Close)
53 vlc_module_end ()
54
55 static block_t *Resample (filter_t *, block_t *);
56
57 static int Open (vlc_object_t *obj)
58 {
59     filter_t *filter = (filter_t *)obj;
60
61     /* Will change rate */
62     if (filter->fmt_in.audio.i_rate == filter->fmt_out.audio.i_rate
63     /* Cannot convert format */
64      || filter->fmt_in.audio.i_format != filter->fmt_out.audio.i_format
65     /* Cannot remix */
66      || filter->fmt_in.audio.i_physical_channels
67                                   != filter->fmt_out.audio.i_physical_channels
68      || filter->fmt_in.audio.i_original_channels
69                                   != filter->fmt_out.audio.i_original_channels)
70         return VLC_EGENERIC;
71
72     switch (filter->fmt_in.audio.i_format)
73     {
74         case VLC_CODEC_FL32: break;
75         case VLC_CODEC_S16N: break;
76         default:             return VLC_EGENERIC;
77     }
78
79     SpeexResamplerState *st;
80
81     unsigned channels = aout_FormatNbChannels (&filter->fmt_in.audio);
82     unsigned q = var_InheritInteger (obj, "speex-resampler-quality");
83     if (unlikely(q > 10))
84         q = 3;
85
86     int err;
87     st = speex_resampler_init(channels, filter->fmt_in.audio.i_rate,
88                               filter->fmt_out.audio.i_rate, q, &err);
89     if (unlikely(st == NULL))
90     {
91         msg_Err (obj, "cannot initialize resampler: %s",
92                  speex_resampler_strerror (err));
93         return VLC_ENOMEM;
94     }
95
96     filter->p_sys = (filter_sys_t *)st;
97     filter->pf_audio_filter = Resample;
98     return VLC_SUCCESS;
99 }
100
101 static void Close (vlc_object_t *obj)
102 {
103     filter_t *filter = (filter_t *)obj;
104     SpeexResamplerState *st = (SpeexResamplerState *)filter->p_sys;
105
106     speex_resampler_destroy (st);
107 }
108
109 static block_t *Resample (filter_t *filter, block_t *in)
110 {
111     SpeexResamplerState *st = (SpeexResamplerState *)filter->p_sys;
112
113     const size_t framesize = filter->fmt_out.audio.i_bytes_per_frame;
114     const unsigned irate = filter->fmt_in.audio.i_rate;
115     const unsigned orate = filter->fmt_out.audio.i_rate;
116
117     spx_uint32_t ilen = in->i_nb_samples;
118     spx_uint32_t olen = ((ilen + 2) * orate * 11) / (irate * 10);
119
120     block_t *out = block_Alloc (olen * framesize);
121     if (unlikely(out == NULL))
122         goto error;
123
124     speex_resampler_set_rate (st, irate, orate);
125
126     int err;
127     if (filter->fmt_in.audio.i_format == VLC_CODEC_FL32)
128         err = speex_resampler_process_interleaved_float (st,
129             (float *)in->p_buffer, &ilen, (float *)out->p_buffer, &olen);
130     else
131         err = speex_resampler_process_interleaved_int (st,
132             (int16_t *)in->p_buffer, &ilen, (int16_t *)out->p_buffer, &olen);
133     if (err != 0)
134     {
135         msg_Err (filter, "cannot resample: %s",
136                  speex_resampler_strerror (err));
137         block_Release (out);
138         out = NULL;
139         goto error;
140     }
141
142     if (ilen < in->i_nb_samples)
143         msg_Err (filter, "lost %"PRIu32" of %u input frames",
144                  in->i_nb_samples - ilen, in->i_nb_samples);
145
146     out->i_buffer = olen * framesize;
147     out->i_nb_samples = olen;
148     out->i_pts = in->i_pts;
149     out->i_length = olen * CLOCK_FREQ / filter->fmt_out.audio.i_rate;
150 error:
151     block_Release (in);
152     return out;
153 }