Fix a segfault (buffer overflow for win32 only).
[vlc.git] / modules / audio_filter / chorus_flanger.c
1 /*****************************************************************************
2  * chorus_flanger.c
3  *****************************************************************************
4  * Copyright (C) 2009 the VideoLAN team
5  * $Id$
6  *
7  * Author: Srikanth Raju < srikiraju at gmail dot com >
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  * GNU General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
22  *****************************************************************************/
23
24 /**
25  * Basic chorus/flanger/delay audio filter
26  * This implements a variable delay filter for VLC. It has some issues with
27  * interpolation and sounding 'correct'.
28  */
29
30
31 #ifdef HAVE_CONFIG_H
32 # include "config.h"
33 #endif
34
35 #include <math.h>
36
37 #include <vlc_common.h>
38 #include <vlc_plugin.h>
39
40 #include <vlc_aout.h>
41
42 /*****************************************************************************
43  * Local prototypes
44  *****************************************************************************/
45
46 static int  Open     ( vlc_object_t * );
47 static void Close    ( vlc_object_t * );
48 static void DoWork   ( aout_instance_t * , aout_filter_t *,
49                        aout_buffer_t * , aout_buffer_t * );
50
51 struct aout_filter_sys_t
52 {
53     /* TODO: Cleanup and optimise */
54     int i_cumulative;
55     int i_channels, i_sampleRate;
56     float f_delayTime, f_feedbackGain;  /* delayTime is in milliseconds */
57     float f_wetLevel, f_dryLevel;
58     float f_sweepDepth, f_sweepRate;
59
60     float f_step,f_offset;
61     int i_step,i_offset;
62     float f_temp;
63     float f_sinMultiplier;
64
65     /* This data is for the the circular queue which stores the samples. */
66     int i_bufferLength;
67     float * pf_delayLineStart, * pf_delayLineEnd;
68     float * pf_write;
69 };
70
71 /*****************************************************************************
72  * Module descriptor
73  *****************************************************************************/
74
75
76 vlc_module_begin ()
77     set_description( N_("Sound Delay") )
78     set_shortname( N_("delay") )
79     set_category( CAT_AUDIO )
80     set_subcategory( SUBCAT_AUDIO_AFILTER )
81     add_shortcut( "delay" )
82     add_float( "delay-time", 40, NULL, N_("Delay time"),
83         N_("Time in milliseconds of the average delay. Note average"), true )
84     add_float( "sweep-depth", 6, NULL, N_("Sweep Depth"),
85         N_("Time in milliseconds of the maximum sweep depth. Thus, the sweep "
86             "range will be delay-time +/- sweep-depth."), true )
87     add_float( "sweep-rate", 6, NULL, N_("Sweep Rate"),
88         N_("Rate of change of sweep depth in milliseconds shift per second "
89            "of play"), true )
90     add_float_with_range( "feedback-gain", 0.5, -0.9, 0.9, NULL,
91         N_("Feedback Gain"), N_("Gain on Feedback loop"), true )
92     add_float_with_range( "wet-mix", 0.4, -0.999, 0.999, NULL,
93         N_("Wet mix"), N_("Level of delayed signal"), true )
94     add_float_with_range( "dry-mix", 0.4, -0.999, 0.999, NULL,
95         N_("Dry Mix"), N_("Level of input signal"), true )
96     set_capability( "audio filter", 0 )
97     set_callbacks( Open, Close )
98 vlc_module_end ()
99
100 /**
101  * small_value: Helper function
102  * return high pass cutoff
103  */
104 static inline float small_value()
105 {
106     /* allows for 2^-24, should be enough for 24-bit DACs at least */
107     return ( 1.0 / 16777216.0 );
108 }
109
110 /**
111  * Open: initialize and create stuff
112  * @param p_this
113  */
114 static int Open( vlc_object_t *p_this )
115 {
116     aout_filter_t *p_filter = (aout_filter_t*)p_this;
117     aout_filter_sys_t *p_sys;
118
119     if ( !AOUT_FMTS_SIMILAR( &p_filter->input, &p_filter->output ) )
120     {
121         msg_Err( p_filter, "input and output formats are not similar" );
122         return VLC_EGENERIC;
123     }
124
125     if( p_filter->input.i_format != VLC_CODEC_FL32 ||
126         p_filter->output.i_format != VLC_CODEC_FL32 )
127     {
128         p_filter->input.i_format = VLC_CODEC_FL32;
129         p_filter->output.i_format = VLC_CODEC_FL32;
130         msg_Warn( p_filter, "bad input or output format" );
131     }
132
133     p_filter->pf_do_work = DoWork;
134     p_filter->b_in_place = true;
135
136     p_sys = p_filter->p_sys = malloc( sizeof( aout_filter_sys_t ) );
137     if( !p_sys )
138         return VLC_ENOMEM;
139
140     p_sys->i_channels       = aout_FormatNbChannels( &p_filter->input );
141     p_sys->f_delayTime      = var_CreateGetFloat( p_this, "delay-time" );
142     p_sys->f_sweepDepth     = var_CreateGetFloat( p_this, "sweep-depth" );
143     p_sys->f_sweepRate      = var_CreateGetFloat( p_this, "sweep-rate" );
144     p_sys->f_feedbackGain   = var_CreateGetFloat( p_this, "feedback-gain" );
145     p_sys->f_dryLevel       = var_CreateGetFloat( p_this, "dry-mix" );
146     p_sys->f_wetLevel       = var_CreateGetFloat( p_this, "wet-mix" );
147
148     if( p_sys->f_delayTime < 0.0)
149     {
150         msg_Err( p_filter, "Delay Time is invalid" );
151         free(p_sys);
152         return VLC_EGENERIC;
153     }
154
155     if( p_sys->f_sweepDepth > p_sys->f_delayTime || p_sys->f_sweepDepth < 0.0 )
156     {
157         msg_Err( p_filter, "Sweep Depth is invalid" );
158         free( p_sys );
159         return VLC_EGENERIC;
160     }
161
162     if( p_sys->f_sweepRate < 0.0 )
163     {
164         msg_Err( p_filter, "Sweep Rate is invalid" );
165         free( p_sys );
166         return VLC_EGENERIC;
167     }
168
169     /* Max delay = delay + depth. Min = delay - depth */
170     p_sys->i_bufferLength = p_sys->i_channels * ( (int)( ( p_sys->f_delayTime
171                 + p_sys->f_sweepDepth ) * p_filter->input.i_rate/1000 ) + 1 );
172
173     msg_Dbg( p_filter , "Buffer length:%d, Channels:%d, Sweep Depth:%f, Delay "
174             "time:%f, Sweep Rate:%f, Sample Rate: %d", p_sys->i_bufferLength,
175             p_sys->i_channels, p_sys->f_sweepDepth, p_sys->f_delayTime,
176             p_sys->f_sweepRate, p_filter->input.i_rate );
177     if( p_sys->i_bufferLength <= 0 )
178     {
179         msg_Err( p_filter, "Delay-time, Sampl rate or Channels was incorrect" );
180         free(p_sys);
181         return VLC_EGENERIC;
182     }
183
184     p_sys->pf_delayLineStart = calloc( p_sys->i_bufferLength, sizeof( float ) );
185     if( !p_sys->pf_delayLineStart )
186     {
187         free( p_sys );
188         return VLC_ENOMEM;
189     }
190
191     p_sys->i_cumulative = 0;
192     p_sys->f_step = p_sys->f_sweepRate / 1000.0;
193     p_sys->i_step = p_sys->f_sweepRate > 0 ? 1 : 0;
194     p_sys->f_offset = 0;
195     p_sys->i_offset = 0;
196     p_sys->f_temp = 0;
197
198     p_sys->pf_delayLineEnd = p_sys->pf_delayLineStart + p_sys->i_bufferLength;
199     p_sys->pf_write = p_sys->pf_delayLineStart;
200
201     if( p_sys->f_sweepDepth < small_value() ||
202             p_filter->input.i_rate < small_value() ) {
203         p_sys->f_sinMultiplier = 0.0;
204     }
205     else {
206         p_sys->f_sinMultiplier = 11 * p_sys->f_sweepRate /
207             ( 7 * p_sys->f_sweepDepth * p_filter->input.i_rate ) ;
208     }
209     p_sys->i_sampleRate = p_filter->input.i_rate;
210
211     return VLC_SUCCESS;
212 }
213
214
215 /**
216  * sanitize: Helper function to eliminate small amplitudes
217  * @param f_value pointer to value to clean
218  */
219 static inline void sanitize( float * f_value )
220 {
221     if ( fabs( *f_value ) < small_value() )
222         *f_value = 0.0f;
223 }
224
225
226 /**
227  * DoWork : delays and finds the value of the current frame
228  * @param p_aout Audio output object
229  * @param p_filter This filter object
230  * @param p_in_buf Input buffer
231  * @param p_out_buf Output buffer
232  */
233 static void DoWork( aout_instance_t *p_aout, aout_filter_t *p_filter,
234                     aout_buffer_t *p_in_buf, aout_buffer_t *p_out_buf )
235 {
236     struct aout_filter_sys_t *p_sys = p_filter->p_sys;
237     int i, i_chan;
238     int i_samples = p_in_buf->i_nb_samples; /* Gives the number of samples */
239     int i_maxOffset = (int)floor( p_sys->f_sweepDepth * p_sys->i_sampleRate /
240             1000 ); /*maximum number of samples to offset in buffer */
241     float *p_out = (float*)p_out_buf->p_buffer;
242     float *p_in =  (float*)p_in_buf->p_buffer;
243
244     float *pf_ptr, f_diff = 0, f_frac = 0, f_temp = 0 ;
245
246     p_out_buf->i_nb_samples = p_in_buf->i_nb_samples;
247     p_out_buf->i_nb_bytes = p_in_buf->i_nb_bytes;
248
249     /* Process each sample */
250     for( i = 0; i < i_samples ; i++ )
251     {
252         /* Use a sine function as a oscillator wave. TODO */
253         /* f_offset = sinf( ( p_sys->i_cumulative ) * p_sys->f_sinMultiplier ) *
254          * (int)floor(p_sys->f_sweepDepth * p_sys->i_sampleRate / 1000);
255          */
256
257         /* Triangle oscillator. Step using ints, because floats give rounding */
258         p_sys->i_offset+=p_sys->i_step;
259         p_sys->f_offset = p_sys->i_offset * p_sys->f_step;
260         if( abs( p_sys->i_step ) > 0 )
261         {
262             if( p_sys->i_offset >=  floor( p_sys->f_sweepDepth *
263                         p_sys->i_sampleRate / p_sys->f_sweepRate ))
264             {
265                 p_sys->f_offset = i_maxOffset;
266                 p_sys->i_step = -1 * ( p_sys->i_step );
267             }
268             if( p_sys->i_offset <= floor( -1 * p_sys->f_sweepDepth *
269                         p_sys->i_sampleRate / p_sys->f_sweepRate ) )
270             {
271                 p_sys->f_offset = -i_maxOffset;
272                 p_sys->i_step = -1 * ( p_sys->i_step );
273             }
274         }
275         /* Calculate position in delay */
276         pf_ptr = p_sys->pf_write + i_maxOffset * p_sys->i_channels +
277             (int)( floor( p_sys->f_offset ) ) * p_sys->i_channels;
278
279         /* Handle Overflow */
280         if( pf_ptr < p_sys->pf_delayLineStart )
281         {
282             pf_ptr += p_sys->i_bufferLength - p_sys->i_channels;
283         }
284         if( pf_ptr > p_sys->pf_delayLineEnd - 2*p_sys->i_channels )
285         {
286             pf_ptr -= p_sys->i_bufferLength - p_sys->i_channels;
287         }
288         /* For interpolation */
289         f_frac = ( p_sys->f_offset - (int)p_sys->f_offset );
290         for( i_chan = 0; i_chan < p_sys->i_channels; i_chan++ )
291         {
292             f_diff =  *( pf_ptr + p_sys->i_channels + i_chan )
293                         - *( pf_ptr + i_chan );
294             f_temp = ( *( pf_ptr + i_chan ) );//+ f_diff * f_frac);
295             /*Linear Interpolation. FIXME. This creates LOTS of noise */
296             sanitize(&f_temp);
297             p_out[i_chan] = p_sys->f_dryLevel * p_in[i_chan] +
298                 p_sys->f_wetLevel * f_temp;
299             *( p_sys->pf_write + i_chan ) = p_in[i_chan] +
300                 p_sys->f_feedbackGain * f_temp;
301         }
302         if( p_sys->pf_write == p_sys->pf_delayLineStart )
303             for( i_chan = 0; i_chan < p_sys->i_channels; i_chan++ )
304                 *( p_sys->pf_delayLineEnd - p_sys->i_channels + i_chan )
305                     = *( p_sys->pf_delayLineStart + i_chan );
306
307         p_in += p_sys->i_channels;
308         p_out += p_sys->i_channels;
309         p_sys->pf_write += p_sys->i_channels;
310         if( p_sys->pf_write == p_sys->pf_delayLineEnd - p_sys->i_channels )
311         {
312             p_sys->pf_write = p_sys->pf_delayLineStart;
313         }
314
315     }
316     return;
317 }
318
319 /**
320  * Close: Destructor
321  * @param p_this pointer to this filter object
322  */
323 static void Close( vlc_object_t *p_this )
324 {
325     aout_filter_t *p_filter = ( aout_filter_t* )p_this;
326     aout_filter_sys_t *p_sys = p_filter->p_sys;
327
328     free( p_sys->pf_delayLineStart );
329     free( p_sys );
330 }