annotate resample2.c @ 2663:b33be8b00488 libavcodec

LE bitstream reader based upon a patch by (Balatoni Denes <dbalatoni programozo hu)
author michael
date Wed, 11 May 2005 01:46:13 +0000
parents 1ee03f2a6cd5
children d4c4b84e0fac
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
1 /*
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
2 * audio resampling
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
3 * Copyright (c) 2004 Michael Niedermayer <michaelni@gmx.at>
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
4 *
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
5 * This library is free software; you can redistribute it and/or
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
6 * modify it under the terms of the GNU Lesser General Public
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
7 * License as published by the Free Software Foundation; either
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
8 * version 2 of the License, or (at your option) any later version.
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
9 *
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
10 * This library is distributed in the hope that it will be useful,
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
13 * Lesser General Public License for more details.
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
14 *
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
15 * You should have received a copy of the GNU Lesser General Public
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
16 * License along with this library; if not, write to the Free Software
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
18 *
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
19 */
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
20
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
21 /**
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
22 * @file resample2.c
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
23 * audio resampling
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
24 * @author Michael Niedermayer <michaelni@gmx.at>
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
25 */
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
26
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
27 #include "avcodec.h"
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
28 #include "common.h"
2114
7f88c429ad65 ugly missing lrintf workaround by ("Steven M. Schultz" <sms at 2bsd dot com>)
michael
parents: 2109
diff changeset
29 #include "dsputil.h"
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
30
2304
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
31 #if 1
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
32 #define FILTER_SHIFT 15
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
33
2304
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
34 #define FELEM int16_t
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
35 #define FELEM2 int32_t
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
36 #define FELEM_MAX INT16_MAX
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
37 #define FELEM_MIN INT16_MIN
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
38 #else
2305
9568c8880d96 optimization
michael
parents: 2304
diff changeset
39 #define FILTER_SHIFT 22
2304
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
40
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
41 #define FELEM int32_t
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
42 #define FELEM2 int64_t
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
43 #define FELEM_MAX INT32_MAX
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
44 #define FELEM_MIN INT32_MIN
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
45 #endif
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
46
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
47
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
48 typedef struct AVResampleContext{
2304
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
49 FELEM *filter_bank;
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
50 int filter_length;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
51 int ideal_dst_incr;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
52 int dst_incr;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
53 int index;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
54 int frac;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
55 int src_incr;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
56 int compensation_distance;
2306
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
57 int phase_shift;
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
58 int phase_mask;
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
59 int linear;
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
60 }AVResampleContext;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
61
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
62 /**
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
63 * 0th order modified bessel function of the first kind.
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
64 */
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
65 double bessel(double x){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
66 double v=1;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
67 double t=1;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
68 int i;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
69
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
70 for(i=1; i<50; i++){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
71 t *= i;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
72 v += pow(x*x/4, i)/(t*t);
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
73 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
74 return v;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
75 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
76
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
77 /**
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
78 * builds a polyphase filterbank.
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
79 * @param factor resampling factor
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
80 * @param scale wanted sum of coefficients for each filter
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
81 * @param type 0->cubic, 1->blackman nuttall windowed sinc, 2->kaiser windowed sinc beta=16
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
82 */
2304
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
83 void av_build_filter(FELEM *filter, double factor, int tap_count, int phase_count, int scale, int type){
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
84 int ph, i, v;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
85 double x, y, w, tab[tap_count];
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
86 const int center= (tap_count-1)/2;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
87
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
88 /* if upsampling, only need to interpolate, no filter */
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
89 if (factor > 1.0)
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
90 factor = 1.0;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
91
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
92 for(ph=0;ph<phase_count;ph++) {
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
93 double norm = 0;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
94 double e= 0;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
95 for(i=0;i<tap_count;i++) {
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
96 x = M_PI * ((double)(i - center) - (double)ph / phase_count) * factor;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
97 if (x == 0) y = 1.0;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
98 else y = sin(x) / x;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
99 switch(type){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
100 case 0:{
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
101 const float d= -0.5; //first order derivative = -0.5
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
102 x = fabs(((double)(i - center) - (double)ph / phase_count) * factor);
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
103 if(x<1.0) y= 1 - 3*x*x + 2*x*x*x + d*( -x*x + x*x*x);
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
104 else y= d*(-4 + 8*x - 5*x*x + x*x*x);
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
105 break;}
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
106 case 1:
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
107 w = 2.0*x / (factor*tap_count) + M_PI;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
108 y *= 0.3635819 - 0.4891775 * cos(w) + 0.1365995 * cos(2*w) - 0.0106411 * cos(3*w);
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
109 break;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
110 case 2:
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
111 w = 2.0*x / (factor*tap_count*M_PI);
2083
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
112 y *= bessel(16*sqrt(FFMAX(1-w*w, 0)));
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
113 break;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
114 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
115
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
116 tab[i] = y;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
117 norm += y;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
118 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
119
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
120 /* normalize so that an uniform color remains the same */
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
121 for(i=0;i<tap_count;i++) {
2304
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
122 v = clip(lrintf(tab[i] * scale / norm + e), FELEM_MIN, FELEM_MAX);
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
123 filter[ph * tap_count + i] = v;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
124 e += tab[i] * scale / norm - v;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
125 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
126 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
127 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
128
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
129 /**
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
130 * initalizes a audio resampler.
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
131 * note, if either rate is not a integer then simply scale both rates up so they are
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
132 */
2308
de38526a1f3f user selectble cutoff frequency
michael
parents: 2307
diff changeset
133 AVResampleContext *av_resample_init(int out_rate, int in_rate, int filter_size, int phase_shift, int linear, double cutoff){
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
134 AVResampleContext *c= av_mallocz(sizeof(AVResampleContext));
2308
de38526a1f3f user selectble cutoff frequency
michael
parents: 2307
diff changeset
135 double factor= FFMIN(out_rate * cutoff / in_rate, 1.0);
2306
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
136 int phase_count= 1<<phase_shift;
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
137
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
138 c->phase_shift= phase_shift;
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
139 c->phase_mask= phase_count-1;
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
140 c->linear= linear;
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
141
2403
6d53608cf2cf special case for filter_length==1
michael
parents: 2346
diff changeset
142 c->filter_length= FFMAX(ceil(filter_size/factor), 1);
2306
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
143 c->filter_bank= av_mallocz(c->filter_length*(phase_count+1)*sizeof(FELEM));
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
144 av_build_filter(c->filter_bank, factor, c->filter_length, phase_count, 1<<FILTER_SHIFT, 1);
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
145 memcpy(&c->filter_bank[c->filter_length*phase_count+1], c->filter_bank, (c->filter_length-1)*sizeof(FELEM));
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
146 c->filter_bank[c->filter_length*phase_count]= c->filter_bank[c->filter_length - 1];
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
147
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
148 c->src_incr= out_rate;
2306
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
149 c->ideal_dst_incr= c->dst_incr= in_rate * phase_count;
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
150 c->index= -phase_count*((c->filter_length-1)/2);
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
151
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
152 return c;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
153 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
154
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
155 void av_resample_close(AVResampleContext *c){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
156 av_freep(&c->filter_bank);
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
157 av_freep(&c);
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
158 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
159
2346
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
160 /**
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
161 * Compensates samplerate/timestamp drift. The compensation is done by changing
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
162 * the resampler parameters, so no audible clicks or similar distortions ocur
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
163 * @param compensation_distance distance in output samples over which the compensation should be performed
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
164 * @param sample_delta number of output samples which should be output less
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
165 *
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
166 * example: av_resample_compensate(c, 10, 500)
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
167 * here instead of 510 samples only 500 samples would be output
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
168 *
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
169 * note, due to rounding the actual compensation might be slightly different,
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
170 * especially if the compensation_distance is large and the in_rate used during init is small
424e6b29de74 av_resample_compensate() doxy
michael
parents: 2308
diff changeset
171 */
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
172 void av_resample_compensate(AVResampleContext *c, int sample_delta, int compensation_distance){
2083
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
173 // sample_delta += (c->ideal_dst_incr - c->dst_incr)*(int64_t)c->compensation_distance / c->ideal_dst_incr;
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
174 c->compensation_distance= compensation_distance;
2083
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
175 c->dst_incr = c->ideal_dst_incr - c->ideal_dst_incr * (int64_t)sample_delta / compensation_distance;
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
176 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
177
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
178 /**
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
179 * resamples.
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
180 * @param src an array of unconsumed samples
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
181 * @param consumed the number of samples of src which have been consumed are returned here
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
182 * @param src_size the number of unconsumed samples available
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
183 * @param dst_size the amount of space in samples available in dst
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
184 * @param update_ctx if this is 0 then the context wont be modified, that way several channels can be resampled with the same context
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
185 * @return the number of samples written in dst or -1 if an error occured
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
186 */
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
187 int av_resample(AVResampleContext *c, short *dst, short *src, int *consumed, int src_size, int dst_size, int update_ctx){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
188 int dst_index, i;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
189 int index= c->index;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
190 int frac= c->frac;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
191 int dst_incr_frac= c->dst_incr % c->src_incr;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
192 int dst_incr= c->dst_incr / c->src_incr;
2277
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
193 int compensation_distance= c->compensation_distance;
2405
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
194
2403
6d53608cf2cf special case for filter_length==1
michael
parents: 2346
diff changeset
195 if(compensation_distance == 0 && c->filter_length == 1 && c->phase_shift==0){
2405
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
196 int64_t index2= ((int64_t)index)<<32;
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
197 int64_t incr= (1LL<<32) * c->dst_incr / c->src_incr;
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
198 dst_size= FFMIN(dst_size, (src_size-1-index) * (int64_t)c->src_incr / c->dst_incr);
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
199
2403
6d53608cf2cf special case for filter_length==1
michael
parents: 2346
diff changeset
200 for(dst_index=0; dst_index < dst_size; dst_index++){
2405
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
201 dst[dst_index] = src[index2>>32];
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
202 index2 += incr;
2403
6d53608cf2cf special case for filter_length==1
michael
parents: 2346
diff changeset
203 }
2405
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
204 frac += dst_index * dst_incr_frac;
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
205 index += dst_index * dst_incr;
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
206 index += frac / c->src_incr;
21c5ef8a4ff7 faster and slightly less accurate nearest neighbor resampler
michael
parents: 2403
diff changeset
207 frac %= c->src_incr;
2403
6d53608cf2cf special case for filter_length==1
michael
parents: 2346
diff changeset
208 }else{
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
209 for(dst_index=0; dst_index < dst_size; dst_index++){
2306
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
210 FELEM *filter= c->filter_bank + c->filter_length*(index & c->phase_mask);
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
211 int sample_index= index >> c->phase_shift;
2304
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
212 FELEM2 val=0;
2277
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
213
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
214 if(sample_index < 0){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
215 for(i=0; i<c->filter_length; i++)
2109
84637c6ca74e various resampling fixes
michael
parents: 2083
diff changeset
216 val += src[ABS(sample_index + i) % src_size] * filter[i];
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
217 }else if(sample_index + c->filter_length > src_size){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
218 break;
2306
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
219 }else if(c->linear){
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
220 int64_t v=0;
2305
9568c8880d96 optimization
michael
parents: 2304
diff changeset
221 int sub_phase= (frac<<8) / c->src_incr;
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
222 for(i=0; i<c->filter_length; i++){
2305
9568c8880d96 optimization
michael
parents: 2304
diff changeset
223 int64_t coeff= filter[i]*(256 - sub_phase) + filter[i + c->filter_length]*sub_phase;
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
224 v += src[sample_index + i] * coeff;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
225 }
2305
9568c8880d96 optimization
michael
parents: 2304
diff changeset
226 val= v>>8;
2306
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
227 }else{
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
228 for(i=0; i<c->filter_length; i++){
2304
09b2ef0ac97d make filter size, int32/int16 and a few other things selectable at compiletime
michael
parents: 2303
diff changeset
229 val += src[sample_index + i] * (FELEM2)filter[i];
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
230 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
231 }
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
232
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
233 val = (val + (1<<(FILTER_SHIFT-1)))>>FILTER_SHIFT;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
234 dst[dst_index] = (unsigned)(val + 32768) > 65535 ? (val>>31) ^ 32767 : val;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
235
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
236 frac += dst_incr_frac;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
237 index += dst_incr;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
238 if(frac >= c->src_incr){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
239 frac -= c->src_incr;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
240 index++;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
241 }
2277
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
242
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
243 if(dst_index + 1 == compensation_distance){
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
244 compensation_distance= 0;
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
245 dst_incr_frac= c->ideal_dst_incr % c->src_incr;
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
246 dst_incr= c->ideal_dst_incr / c->src_incr;
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
247 }
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
248 }
2403
6d53608cf2cf special case for filter_length==1
michael
parents: 2346
diff changeset
249 }
2306
072fc321fbe6 make most resample filter parameters selectable at runtime
michael
parents: 2305
diff changeset
250 *consumed= FFMAX(index, 0) >> c->phase_shift;
2307
df3e4a8e6aac 100l (dont reset the sample position at the block end)
michael
parents: 2306
diff changeset
251 if(index>=0) index &= c->phase_mask;
2109
84637c6ca74e various resampling fixes
michael
parents: 2083
diff changeset
252
2277
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
253 if(compensation_distance){
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
254 compensation_distance -= dst_index;
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
255 assert(compensation_distance > 0);
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
256 }
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
257 if(update_ctx){
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
258 c->frac= frac;
2109
84637c6ca74e various resampling fixes
michael
parents: 2083
diff changeset
259 c->index= index;
2277
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
260 c->dst_incr= dst_incr_frac + c->src_incr*dst_incr;
b88e05b9b445 dont just resample half of the data sometimes
michael
parents: 2171
diff changeset
261 c->compensation_distance= compensation_distance;
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
262 }
2083
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
263 #if 0
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
264 if(update_ctx && !c->compensation_distance){
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
265 #undef rand
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
266 av_resample_compensate(c, rand() % (8000*2) - 8000, 8000*2);
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
267 av_log(NULL, AV_LOG_DEBUG, "%d %d %d\n", c->dst_incr, c->ideal_dst_incr, c->compensation_distance);
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
268 }
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
269 #endif
76cdbe832239 avoid useless normalization and 10l fix
michael
parents: 2082
diff changeset
270
2082
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
271 return dst_index;
3dc9bbe1b152 polyphase kaiser windowed sinc and blackman nuttall windowed sinc audio resample filters
michael
parents:
diff changeset
272 }