48
53
static void DoWork ( aout_instance_t *, aout_filter_t *, aout_buffer_t *,
51
static void FilterFloatUP( float Imp[], float ImpD[], uint16_t Nwing,
57
static int OpenFilter ( vlc_object_t * );
58
static void CloseFilter( vlc_object_t * );
59
static block_t *Resample( filter_t *, block_t * );
62
static void FilterFloatUP( const float Imp[], const float ImpD[], uint16_t Nwing,
52
63
float *f_in, float *f_out, uint32_t ui_remainder,
53
64
uint32_t ui_output_rate, int16_t Inc,
54
65
int i_nb_channels );
56
static void FilterFloatUD( float Imp[], float ImpD[], uint16_t Nwing,
67
static void FilterFloatUD( const float Imp[], const float ImpD[], uint16_t Nwing,
57
68
float *f_in, float *f_out, uint32_t ui_remainder,
58
69
uint32_t ui_output_rate, uint32_t ui_input_rate,
59
70
int16_t Inc, int i_nb_channels );
116
136
/* Allocate the memory needed to store the module's structure */
117
p_filter->p_sys = malloc( sizeof(struct aout_filter_sys_t) );
118
if( p_filter->p_sys == NULL )
120
msg_Err( p_filter, "out of memory" );
137
p_sys = malloc( sizeof(filter_sys_t) );
121
139
return VLC_ENOMEM;
140
p_filter->p_sys = (struct aout_filter_sys_t *)p_sys;
124
142
/* Calculate worst case for the length of the filter wing */
125
143
d_factor = (double)p_filter->output.i_rate
126
/ p_filter->input.i_rate;
144
/ p_filter->input.i_rate / AOUT_MAX_INPUT_RATE;
127
145
i_filter_wing = ((SMALL_FILTER_NMULT + 1)/2.0)
128
146
* __MAX(1.0, 1.0/d_factor) + 10;
129
p_filter->p_sys->i_buf_size = aout_FormatNbChannels( &p_filter->input ) *
147
p_sys->i_buf_size = aout_FormatNbChannels( &p_filter->input ) *
130
148
sizeof(int32_t) * 2 * i_filter_wing;
132
150
/* Allocate enough memory to buffer previous samples */
133
p_filter->p_sys->p_buf = malloc( p_filter->p_sys->i_buf_size );
134
if( p_filter->p_sys->p_buf == NULL )
151
p_sys->p_buf = malloc( p_sys->i_buf_size );
152
if( p_sys->p_buf == NULL )
136
msg_Err( p_filter, "out of memory" );
137
155
return VLC_ENOMEM;
140
p_filter->p_sys->i_old_wing = 0;
158
p_sys->i_old_wing = 0;
159
p_sys->b_filter2 = false; /* It seams to be a good valuefor this module */
141
160
p_filter->pf_do_work = DoWork;
143
162
/* We don't want a new buffer to be created because we're not sure we'll
144
163
* actually need to resample anything. */
145
p_filter->b_in_place = VLC_TRUE;
164
p_filter->b_in_place = true;
147
166
return VLC_SUCCESS;
163
183
static void DoWork( aout_instance_t * p_aout, aout_filter_t * p_filter,
164
184
aout_buffer_t * p_in_buf, aout_buffer_t * p_out_buf )
186
filter_sys_t *p_sys = (filter_sys_t *)p_filter->p_sys;
166
187
float *p_in, *p_in_orig, *p_out = (float *)p_out_buf->p_buffer;
168
189
int i_nb_channels = aout_FormatNbChannels( &p_filter->input );
169
190
int i_in_nb = p_in_buf->i_nb_samples;
170
191
int i_in, i_out = 0;
192
unsigned int i_out_rate;
171
193
double d_factor, d_scale_factor, d_old_scale_factor;
172
194
int i_filter_wing;
196
if( p_sys->b_filter2 )
197
i_out_rate = p_filter->output.i_rate;
199
i_out_rate = p_aout->mixer.mixer.i_rate;
177
201
/* Check if we really need to run the resampler */
178
if( p_aout->mixer.mixer.i_rate == p_filter->input.i_rate )
202
if( i_out_rate == p_filter->input.i_rate )
180
if( //p_filter->b_continuity && /* What difference does it make ? :) */
181
p_filter->p_sys->i_old_wing &&
204
if( /*p_filter->b_continuity && /--* What difference does it make ? :) */
182
206
p_in_buf->i_size >=
183
p_in_buf->i_nb_bytes + p_filter->p_sys->i_old_wing *
207
p_in_buf->i_nb_bytes + p_sys->i_old_wing *
184
208
p_filter->input.i_bytes_per_frame )
186
210
/* output the whole thing with the samples from last time */
187
211
memmove( ((float *)(p_in_buf->p_buffer)) +
188
i_nb_channels * p_filter->p_sys->i_old_wing,
212
i_nb_channels * p_sys->i_old_wing,
189
213
p_in_buf->p_buffer, p_in_buf->i_nb_bytes );
190
memcpy( p_in_buf->p_buffer, p_filter->p_sys->p_buf +
191
i_nb_channels * p_filter->p_sys->i_old_wing,
192
p_filter->p_sys->i_old_wing *
214
memcpy( p_in_buf->p_buffer, p_sys->p_buf +
215
i_nb_channels * p_sys->i_old_wing,
193
217
p_filter->input.i_bytes_per_frame );
195
219
p_out_buf->i_nb_samples = p_in_buf->i_nb_samples +
196
p_filter->p_sys->i_old_wing;
198
p_out_buf->start_date = aout_DateGet( &p_filter->p_sys->end_date );
222
p_out_buf->start_date = aout_DateGet( &p_sys->end_date );
199
223
p_out_buf->end_date =
200
aout_DateIncrement( &p_filter->p_sys->end_date,
224
aout_DateIncrement( &p_sys->end_date,
201
225
p_out_buf->i_nb_samples );
203
227
p_out_buf->i_nb_bytes = p_out_buf->i_nb_samples *
204
228
p_filter->input.i_bytes_per_frame;
206
p_filter->b_continuity = VLC_FALSE;
207
p_filter->p_sys->i_old_wing = 0;
230
p_filter->b_continuity = false;
231
p_sys->i_old_wing = 0;
213
237
/* Continuity in sound samples has been broken, we'd better reset
215
p_filter->b_continuity = VLC_TRUE;
216
p_filter->p_sys->i_remainder = 0;
217
aout_DateInit( &p_filter->p_sys->end_date, p_filter->output.i_rate );
218
aout_DateSet( &p_filter->p_sys->end_date, p_in_buf->start_date );
219
p_filter->p_sys->i_old_rate = p_filter->input.i_rate;
220
p_filter->p_sys->d_old_factor = 1;
221
p_filter->p_sys->i_old_wing = 0;
239
p_filter->b_continuity = true;
240
p_sys->i_remainder = 0;
241
aout_DateInit( &p_sys->end_date, i_out_rate );
242
aout_DateSet( &p_sys->end_date, p_in_buf->start_date );
243
p_sys->i_old_rate = p_filter->input.i_rate;
244
p_sys->d_old_factor = 1;
245
p_sys->i_old_wing = 0;
225
249
msg_Err( p_filter, "old rate: %i, old factor: %f, old wing: %i, i_in: %i",
226
p_filter->p_sys->i_old_rate, p_filter->p_sys->d_old_factor,
227
p_filter->p_sys->i_old_wing, i_in_nb );
250
p_sys->i_old_rate, p_sys->d_old_factor,
251
p_sys->i_old_wing, i_in_nb );
230
254
/* Prepare the source buffer */
231
i_in_nb += (p_filter->p_sys->i_old_wing * 2);
255
i_in_nb += (p_sys->i_old_wing * 2);
232
256
#ifdef HAVE_ALLOCA
233
257
p_in = p_in_orig = (float *)alloca( i_in_nb *
234
258
p_filter->input.i_bytes_per_frame );
244
268
/* Copy all our samples in p_in */
245
if( p_filter->p_sys->i_old_wing )
269
if( p_sys->i_old_wing )
247
p_aout->p_vlc->pf_memcpy( p_in, p_filter->p_sys->p_buf,
248
p_filter->p_sys->i_old_wing * 2 *
249
p_filter->input.i_bytes_per_frame );
271
vlc_memcpy( p_in, p_sys->p_buf,
272
p_sys->i_old_wing * 2 *
273
p_filter->input.i_bytes_per_frame );
251
p_aout->p_vlc->pf_memcpy( p_in + p_filter->p_sys->i_old_wing * 2 *
252
i_nb_channels, p_in_buf->p_buffer,
253
p_in_buf->i_nb_samples *
254
p_filter->input.i_bytes_per_frame );
275
vlc_memcpy( p_in + p_sys->i_old_wing * 2 * i_nb_channels,
277
p_in_buf->i_nb_samples * p_filter->input.i_bytes_per_frame );
256
279
/* Make sure the output buffer is reset */
257
280
memset( p_out, 0, p_out_buf->i_size );
259
282
/* Calculate the new length of the filter wing */
260
d_factor = (double)p_aout->mixer.mixer.i_rate / p_filter->input.i_rate;
283
d_factor = (double)i_out_rate / p_filter->input.i_rate;
261
284
i_filter_wing = ((SMALL_FILTER_NMULT+1)/2.0) * __MAX(1.0,1.0/d_factor) + 1;
263
286
/* Account for increased filter gain when using factors less than 1 */
264
287
d_old_scale_factor = SMALL_FILTER_SCALE *
265
p_filter->p_sys->d_old_factor + 0.5;
288
p_sys->d_old_factor + 0.5;
266
289
d_scale_factor = SMALL_FILTER_SCALE * d_factor + 0.5;
268
291
/* Apply the old rate until we have enough samples for the new one */
269
i_in = p_filter->p_sys->i_old_wing;
270
p_in += p_filter->p_sys->i_old_wing * i_nb_channels;
292
i_in = p_sys->i_old_wing;
293
p_in += p_sys->i_old_wing * i_nb_channels;
271
294
for( ; i_in < i_filter_wing &&
272
(i_in + p_filter->p_sys->i_old_wing) < i_in_nb; i_in++ )
295
(i_in + p_sys->i_old_wing) < i_in_nb; i_in++ )
274
if( p_filter->p_sys->d_old_factor == 1 )
297
if( p_sys->d_old_factor == 1 )
276
299
/* Just copy the samples */
278
p_filter->input.i_bytes_per_frame );
301
p_filter->input.i_bytes_per_frame );
279
302
p_in += i_nb_channels;
280
303
p_out += i_nb_channels;
285
while( p_filter->p_sys->i_remainder < p_filter->output.i_rate )
308
while( p_sys->i_remainder < p_filter->output.i_rate )
288
if( p_filter->p_sys->d_old_factor >= 1 )
311
if( p_sys->d_old_factor >= 1 )
290
313
/* FilterFloatUP() is faster if we can use it */
292
315
/* Perform left-wing inner product */
293
316
FilterFloatUP( SMALL_FILTER_FLOAT_IMP, SMALL_FILTER_FLOAT_IMPD,
294
317
SMALL_FILTER_NWING, p_in, p_out,
295
p_filter->p_sys->i_remainder,
296
319
p_filter->output.i_rate,
297
320
-1, i_nb_channels );
298
321
/* Perform right-wing inner product */
299
322
FilterFloatUP( SMALL_FILTER_FLOAT_IMP, SMALL_FILTER_FLOAT_IMPD,
300
323
SMALL_FILTER_NWING, p_in + i_nb_channels, p_out,
301
324
p_filter->output.i_rate -
302
p_filter->p_sys->i_remainder,
303
326
p_filter->output.i_rate,
304
327
1, i_nb_channels );
326
349
/* Perform left-wing inner product */
327
350
FilterFloatUD( SMALL_FILTER_FLOAT_IMP, SMALL_FILTER_FLOAT_IMPD,
328
351
SMALL_FILTER_NWING, p_in, p_out,
329
p_filter->p_sys->i_remainder,
330
353
p_filter->output.i_rate, p_filter->input.i_rate,
331
354
-1, i_nb_channels );
332
355
/* Perform right-wing inner product */
333
356
FilterFloatUD( SMALL_FILTER_FLOAT_IMP, SMALL_FILTER_FLOAT_IMPD,
334
357
SMALL_FILTER_NWING, p_in + i_nb_channels, p_out,
335
358
p_filter->output.i_rate -
336
p_filter->p_sys->i_remainder,
337
360
p_filter->output.i_rate, p_filter->input.i_rate,
338
361
1, i_nb_channels );
401
424
/* Perform left-wing inner product */
402
425
FilterFloatUD( SMALL_FILTER_FLOAT_IMP, SMALL_FILTER_FLOAT_IMPD,
403
426
SMALL_FILTER_NWING, p_in, p_out,
404
p_filter->p_sys->i_remainder,
405
428
p_filter->output.i_rate, p_filter->input.i_rate,
406
429
-1, i_nb_channels );
407
430
/* Perform right-wing inner product */
408
431
FilterFloatUD( SMALL_FILTER_FLOAT_IMP, SMALL_FILTER_FLOAT_IMPD,
409
432
SMALL_FILTER_NWING, p_in + i_nb_channels, p_out,
410
433
p_filter->output.i_rate -
411
p_filter->p_sys->i_remainder,
412
435
p_filter->output.i_rate, p_filter->input.i_rate,
413
436
1, i_nb_channels );
456
void FilterFloatUP( float Imp[], float ImpD[], uint16_t Nwing, float *p_in,
479
/*****************************************************************************
481
*****************************************************************************/
482
static int OpenFilter( vlc_object_t *p_this )
484
filter_t *p_filter = (filter_t *)p_this;
486
unsigned int i_out_rate = p_filter->fmt_out.audio.i_rate;
490
if( p_filter->fmt_in.audio.i_rate == p_filter->fmt_out.audio.i_rate ||
491
p_filter->fmt_in.i_codec != VLC_FOURCC('f','l','3','2') )
496
#if !defined( SYS_DARWIN )
497
if( !config_GetInt( p_this, "hq-resampling" ) )
503
/* Allocate the memory needed to store the module's structure */
504
p_filter->p_sys = p_sys = malloc( sizeof(struct filter_sys_t) );
508
/* Calculate worst case for the length of the filter wing */
509
d_factor = (double)i_out_rate / p_filter->fmt_in.audio.i_rate;
510
i_filter_wing = ((SMALL_FILTER_NMULT + 1)/2.0)
511
* __MAX(1.0, 1.0/d_factor) + 10;
512
p_filter->p_sys->i_buf_size = p_filter->fmt_in.audio.i_channels *
513
sizeof(int32_t) * 2 * i_filter_wing;
515
/* Allocate enough memory to buffer previous samples */
516
p_filter->p_sys->p_buf = malloc( p_filter->p_sys->i_buf_size );
517
if( p_filter->p_sys->p_buf == NULL )
523
p_filter->p_sys->i_old_wing = 0;
524
p_sys->b_first = true;
525
p_sys->b_filter2 = true;
526
p_filter->pf_audio_filter = Resample;
528
msg_Dbg( p_this, "%4.4s/%iKHz/%i->%4.4s/%iKHz/%i",
529
(char *)&p_filter->fmt_in.i_codec,
530
p_filter->fmt_in.audio.i_rate,
531
p_filter->fmt_in.audio.i_channels,
532
(char *)&p_filter->fmt_out.i_codec,
533
p_filter->fmt_out.audio.i_rate,
534
p_filter->fmt_out.audio.i_channels);
536
p_filter->fmt_out = p_filter->fmt_in;
537
p_filter->fmt_out.audio.i_rate = i_out_rate;
542
/*****************************************************************************
543
* CloseFilter : deallocate data structures
544
*****************************************************************************/
545
static void CloseFilter( vlc_object_t *p_this )
547
filter_t *p_filter = (filter_t *)p_this;
548
free( p_filter->p_sys->p_buf );
549
free( p_filter->p_sys );
552
/*****************************************************************************
554
*****************************************************************************/
555
static block_t *Resample( filter_t *p_filter, block_t *p_block )
557
aout_filter_t aout_filter;
558
aout_buffer_t in_buf, out_buf;
561
int i_bytes_per_frame;
563
if( !p_block || !p_block->i_samples )
565
if( p_block ) p_block->pf_release( p_block );
569
i_bytes_per_frame = p_filter->fmt_out.audio.i_channels *
570
p_filter->fmt_out.audio.i_bitspersample / 8;
572
i_out_size = i_bytes_per_frame * ( 1 + (p_block->i_samples *
573
p_filter->fmt_out.audio.i_rate / p_filter->fmt_in.audio.i_rate));
575
p_out = p_filter->pf_audio_buffer_new( p_filter, i_out_size );
578
msg_Warn( p_filter, "can't get output buffer" );
579
p_block->pf_release( p_block );
583
p_out->i_samples = i_out_size / i_bytes_per_frame;
584
p_out->i_dts = p_block->i_dts;
585
p_out->i_pts = p_block->i_pts;
586
p_out->i_length = p_block->i_length;
588
aout_filter.p_sys = (struct aout_filter_sys_t *)p_filter->p_sys;
589
aout_filter.input = p_filter->fmt_in.audio;
590
aout_filter.input.i_bytes_per_frame = p_filter->fmt_in.audio.i_channels *
591
p_filter->fmt_in.audio.i_bitspersample / 8;
592
aout_filter.output = p_filter->fmt_out.audio;
593
aout_filter.output.i_bytes_per_frame = p_filter->fmt_out.audio.i_channels *
594
p_filter->fmt_out.audio.i_bitspersample / 8;
595
aout_filter.b_continuity = !p_filter->p_sys->b_first;
596
p_filter->p_sys->b_first = false;
598
in_buf.p_buffer = p_block->p_buffer;
599
in_buf.i_nb_bytes = in_buf.i_size = p_block->i_buffer;
600
in_buf.i_nb_samples = p_block->i_samples;
601
out_buf.p_buffer = p_out->p_buffer;
602
out_buf.i_nb_bytes = out_buf.i_size = p_out->i_buffer;
603
out_buf.i_nb_samples = p_out->i_samples;
605
DoWork( (aout_instance_t *)p_filter, &aout_filter, &in_buf, &out_buf );
607
p_block->pf_release( p_block );
609
p_out->i_buffer = out_buf.i_nb_bytes;
610
p_out->i_samples = out_buf.i_nb_samples;
615
void FilterFloatUP( const float Imp[], const float ImpD[], uint16_t Nwing, float *p_in,
457
616
float *p_out, uint32_t ui_remainder,
458
617
uint32_t ui_output_rate, int16_t Inc, int i_nb_channels )
460
float *Hp, *Hdp, *End;
619
const float *Hp, *Hdp, *End;
462
621
uint32_t ui_linear_remainder;