Mercurial > mplayer.hg
annotate libaf/af_resample.c @ 14322:e0f63bf677c0
synced to 1.74 (typo fix)
author | gabrov |
---|---|
date | Mon, 03 Jan 2005 10:19:48 +0000 |
parents | de13fd557440 |
children | 95bb94a930a3 |
rev | line source |
---|---|
7568 | 1 /*============================================================================= |
2 // | |
13602
14090f7300a8
The full name of the GPL is GNU General Public License.
diego
parents:
8905
diff
changeset
|
3 // This software has been released under the terms of the GNU General Public |
7568 | 4 // license. See http://www.gnu.org/copyleft/gpl.html for details. |
5 // | |
6 // Copyright 2002 Anders Johansson ajh@atri.curtin.edu.au | |
7 // | |
8 //============================================================================= | |
9 */ | |
10 | |
11 /* This audio filter changes the sample rate. */ | |
12 #include <stdio.h> | |
13 #include <stdlib.h> | |
14 #include <unistd.h> | |
15 #include <inttypes.h> | |
16 | |
17 #include "af.h" | |
18 #include "dsp.h" | |
19 | |
20 /* Below definition selects the length of each poly phase component. | |
21 Valid definitions are L8 and L16, where the number denotes the | |
22 length of the filter. This definition affects the computational | |
23 complexity (see play()), the performance (see filter.h) and the | |
24 memory usage. The filterlenght is choosen to 8 if the machine is | |
25 slow and to 16 if the machine is fast and has MMX. | |
26 */ | |
27 | |
8607 | 28 #if !defined(HAVE_MMX) // This machine is slow |
29 #define L8 | |
30 #else | |
31 #define L16 | |
32 #endif | |
7568 | 33 |
8607 | 34 #include "af_resample.h" |
7568 | 35 |
8607 | 36 // Filtering types |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
37 #define RSMP_LIN (0<<0) // Linear interpolation |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
38 #define RSMP_INT (1<<0) // 16 bit integer |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
39 #define RSMP_FLOAT (2<<0) // 32 bit floating point |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
40 #define RSMP_MASK (3<<0) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
41 |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
42 // Defines for sloppy or exact resampling |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
43 #define FREQ_SLOPPY (0<<2) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
44 #define FREQ_EXACT (1<<2) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
45 #define FREQ_MASK (1<<2) |
7568 | 46 |
8607 | 47 // Accuracy for linear interpolation |
48 #define STEPACCURACY 32 | |
7568 | 49 |
50 // local data | |
51 typedef struct af_resample_s | |
52 { | |
8607 | 53 void* w; // Current filter weights |
54 void** xq; // Circular buffers | |
7580 | 55 uint32_t xi; // Index for circular buffers |
56 uint32_t wi; // Index for w | |
8607 | 57 uint32_t i; // Number of new samples to put in x queue |
7580 | 58 uint32_t dn; // Down sampling factor |
59 uint32_t up; // Up sampling factor | |
8607 | 60 uint64_t step; // Step size for linear interpolation |
61 uint64_t pt; // Pointer remainder for linear interpolation | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
62 int setup; // Setup parameters cmdline or through postcreate |
7568 | 63 } af_resample_t; |
64 | |
65 // Euclids algorithm for calculating Greatest Common Divisor GCD(a,b) | |
7894 | 66 static inline int gcd(register int a, register int b) |
7568 | 67 { |
68 register int r = min(a,b); | |
69 a=max(a,b); | |
70 b=r; | |
71 | |
72 r=a%b; | |
73 while(r!=0){ | |
74 a=b; | |
75 b=r; | |
76 r=a%b; | |
77 } | |
78 return b; | |
79 } | |
80 | |
8607 | 81 // Fast linear interpolation resample with modest audio quality |
82 static int linint(af_data_t* c,af_data_t* l, af_resample_t* s) | |
7568 | 83 { |
8607 | 84 uint32_t len = 0; // Number of input samples |
85 uint32_t nch = l->nch; // Words pre transfer | |
86 uint64_t step = s->step; | |
87 int16_t* in16 = ((int16_t*)c->audio); | |
88 int16_t* out16 = ((int16_t*)l->audio); | |
89 int32_t* in32 = ((int32_t*)c->audio); | |
90 int32_t* out32 = ((int32_t*)l->audio); | |
91 uint64_t end = ((((uint64_t)c->len)/2LL)<<STEPACCURACY); | |
92 uint64_t pt = s->pt; | |
93 uint16_t tmp; | |
94 | |
95 switch (nch){ | |
96 case 1: | |
97 while(pt < end){ | |
98 out16[len++]=in16[pt>>STEPACCURACY]; | |
99 pt+=step; | |
7568 | 100 } |
8607 | 101 s->pt=pt & ((1LL<<STEPACCURACY)-1); |
102 break; | |
103 case 2: | |
104 end/=2; | |
105 while(pt < end){ | |
106 out32[len++]=in32[pt>>STEPACCURACY]; | |
107 pt+=step; | |
108 } | |
109 len=(len<<1); | |
110 s->pt=pt & ((1LL<<STEPACCURACY)-1); | |
111 break; | |
112 default: | |
113 end /=nch; | |
114 while(pt < end){ | |
115 tmp=nch; | |
116 do { | |
117 tmp--; | |
118 out16[len+tmp]=in16[tmp+(pt>>STEPACCURACY)*nch]; | |
119 } while (tmp); | |
120 len+=nch; | |
121 pt+=step; | |
122 } | |
123 s->pt=pt & ((1LL<<STEPACCURACY)-1); | |
7568 | 124 } |
125 return len; | |
126 } | |
127 | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
128 /* Determine resampling type and format */ |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
129 static int set_types(struct af_instance_s* af, af_data_t* data) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
130 { |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
131 af_resample_t* s = af->setup; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
132 int rv = AF_OK; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
133 float rd = 0; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
134 |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
135 // Make sure this filter isn't redundant |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
136 if((af->data->rate == data->rate) || (af->data->rate == 0)) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
137 return AF_DETACH; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
138 /* If sloppy and small resampling difference (2%) */ |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
139 rd = abs((float)af->data->rate - (float)data->rate)/(float)data->rate; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
140 if((((s->setup & FREQ_MASK) == FREQ_SLOPPY) && (rd < 0.02) && |
14245 | 141 (data->format != (AF_FORMAT_FLOAT_NE))) || |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
142 ((s->setup & RSMP_MASK) == RSMP_LIN)){ |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
143 s->setup = (s->setup & ~RSMP_MASK) | RSMP_LIN; |
14245 | 144 af->data->format = AF_FORMAT_S16_NE; |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
145 af->data->bps = 2; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
146 af_msg(AF_MSG_VERBOSE,"[resample] Using linear interpolation. \n"); |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
147 } |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
148 else{ |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
149 /* If the input format is float or if float is explicitly selected |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
150 use float, otherwise use int */ |
14245 | 151 if((data->format == (AF_FORMAT_FLOAT_NE)) || |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
152 ((s->setup & RSMP_MASK) == RSMP_FLOAT)){ |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
153 s->setup = (s->setup & ~RSMP_MASK) | RSMP_FLOAT; |
14245 | 154 af->data->format = AF_FORMAT_FLOAT_NE; |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
155 af->data->bps = 4; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
156 } |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
157 else{ |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
158 s->setup = (s->setup & ~RSMP_MASK) | RSMP_INT; |
14245 | 159 af->data->format = AF_FORMAT_S16_NE; |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
160 af->data->bps = 2; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
161 } |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
162 af_msg(AF_MSG_VERBOSE,"[resample] Using %s processing and %s frequecy" |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
163 " conversion.\n", |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
164 ((s->setup & RSMP_MASK) == RSMP_FLOAT)?"floating point":"integer", |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
165 ((s->setup & FREQ_MASK) == FREQ_SLOPPY)?"inexact":"exact"); |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
166 } |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
167 |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
168 if(af->data->format != data->format || af->data->bps != data->bps) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
169 rv = AF_FALSE; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
170 data->format = af->data->format; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
171 data->bps = af->data->bps; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
172 af->data->nch = data->nch; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
173 return rv; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
174 } |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
175 |
7568 | 176 // Initialization and runtime control |
177 static int control(struct af_instance_s* af, int cmd, void* arg) | |
178 { | |
179 switch(cmd){ | |
180 case AF_CONTROL_REINIT:{ | |
181 af_resample_t* s = (af_resample_t*)af->setup; | |
182 af_data_t* n = (af_data_t*)arg; // New configureation | |
183 int i,d = 0; | |
184 int rv = AF_OK; | |
185 | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
186 // Free space for circular bufers |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
187 if(s->xq){ |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
188 for(i=1;i<af->data->nch;i++) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
189 if(s->xq[i]) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
190 free(s->xq[i]); |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
191 free(s->xq); |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
192 } |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
193 |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
194 if(AF_DETACH == (rv = set_types(af,n))) |
7568 | 195 return AF_DETACH; |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
196 |
8607 | 197 // If linear interpolation |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
198 if((s->setup & RSMP_MASK) == RSMP_LIN){ |
8607 | 199 s->pt=0LL; |
200 s->step=((uint64_t)n->rate<<STEPACCURACY)/(uint64_t)af->data->rate+1LL; | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
201 af_msg(AF_MSG_DEBUG0,"[resample] Linear interpolation step: 0x%016X.\n", |
8607 | 202 s->step); |
203 af->mul.n = af->data->rate; | |
204 af->mul.d = n->rate; | |
8905 | 205 return rv; |
7568 | 206 } |
207 | |
208 // Calculate up and down sampling factors | |
209 d=gcd(af->data->rate,n->rate); | |
210 | |
7998
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
211 // If sloppy resampling is enabled limit the upsampling factor |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
212 if(((s->setup & FREQ_MASK) == FREQ_SLOPPY) && (af->data->rate/d > 5000)){ |
7998
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
213 int up=af->data->rate/2; |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
214 int dn=n->rate/2; |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
215 int m=2; |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
216 while(af->data->rate/(d*m) > 5000){ |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
217 d=gcd(up,dn); |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
218 up/=2; dn/=2; m*=2; |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
219 } |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
220 d*=m; |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
221 } |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
222 |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
223 // Create space for circular bufers |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
224 s->xq = malloc(n->nch*sizeof(void*)); |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
225 for(i=0;i<n->nch;i++) |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
226 s->xq[i] = malloc(2*L*af->data->bps); |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
227 s->xi = 0; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
228 |
7568 | 229 // Check if the the design needs to be redone |
230 if(s->up != af->data->rate/d || s->dn != n->rate/d){ | |
231 float* w; | |
232 float* wt; | |
233 float fc; | |
234 int j; | |
235 s->up = af->data->rate/d; | |
236 s->dn = n->rate/d; | |
237 | |
238 // Calculate cuttof frequency for filter | |
239 fc = 1/(float)(max(s->up,s->dn)); | |
240 // Allocate space for polyphase filter bank and protptype filter | |
241 w = malloc(sizeof(float) * s->up *L); | |
242 if(NULL != s->w) | |
243 free(s->w); | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
244 s->w = malloc(L*s->up*af->data->bps); |
7568 | 245 |
246 // Design prototype filter type using Kaiser window with beta = 10 | |
247 if(NULL == w || NULL == s->w || | |
14275
de13fd557440
less namespace pollution #2 (prefixed globals in filter.c with af_filter_)
alex
parents:
14245
diff
changeset
|
248 -1 == af_filter_design_fir(s->up*L, w, &fc, LP|KAISER , 10.0)){ |
8167 | 249 af_msg(AF_MSG_ERROR,"[resample] Unable to design prototype filter.\n"); |
7568 | 250 return AF_ERROR; |
251 } | |
252 // Copy data from prototype to polyphase filter | |
253 wt=w; | |
254 for(j=0;j<L;j++){//Columns | |
255 for(i=0;i<s->up;i++){//Rows | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
256 if((s->setup & RSMP_MASK) == RSMP_INT){ |
8607 | 257 float t=(float)s->up*32767.0*(*wt); |
258 ((int16_t*)s->w)[i*L+j] = (int16_t)((t>=0.0)?(t+0.5):(t-0.5)); | |
259 } | |
260 else | |
261 ((float*)s->w)[i*L+j] = (float)s->up*(*wt); | |
7568 | 262 wt++; |
263 } | |
264 } | |
265 free(w); | |
8607 | 266 af_msg(AF_MSG_VERBOSE,"[resample] New filter designed up: %i " |
267 "down: %i\n", s->up, s->dn); | |
7568 | 268 } |
269 | |
7665
fbd5445cc853
Adding function for calculating the delay caused by the filters
anders
parents:
7616
diff
changeset
|
270 // Set multiplier and delay |
fbd5445cc853
Adding function for calculating the delay caused by the filters
anders
parents:
7616
diff
changeset
|
271 af->delay = (double)(1000*L/2)/((double)n->rate); |
7568 | 272 af->mul.n = s->up; |
273 af->mul.d = s->dn; | |
274 return rv; | |
275 } | |
7998
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
276 case AF_CONTROL_COMMAND_LINE:{ |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
277 af_resample_t* s = (af_resample_t*)af->setup; |
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
278 int rate=0; |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
279 int type=RSMP_INT; |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
280 int sloppy=1; |
8868
398e3fb7c103
10l bug for float conversion control + feature fix in volume control
anders
parents:
8867
diff
changeset
|
281 sscanf((char*)arg,"%i:%i:%i", &rate, &sloppy, &type); |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
282 s->setup = (sloppy?FREQ_SLOPPY:FREQ_EXACT) | |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
283 (clamp(type,RSMP_LIN,RSMP_FLOAT)); |
8607 | 284 return af->control(af,AF_CONTROL_RESAMPLE_RATE | AF_CONTROL_SET, &rate); |
7998
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7894
diff
changeset
|
285 } |
8607 | 286 case AF_CONTROL_POST_CREATE: |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
287 if((((af_cfg_t*)arg)->force & AF_INIT_FORMAT_MASK) == AF_INIT_FLOAT) |
8868
398e3fb7c103
10l bug for float conversion control + feature fix in volume control
anders
parents:
8867
diff
changeset
|
288 ((af_resample_t*)af->setup)->setup = RSMP_FLOAT; |
8607 | 289 return AF_OK; |
290 case AF_CONTROL_RESAMPLE_RATE | AF_CONTROL_SET: | |
7568 | 291 // Reinit must be called after this function has been called |
292 | |
293 // Sanity check | |
7616 | 294 if(((int*)arg)[0] < 8000 || ((int*)arg)[0] > 192000){ |
8607 | 295 af_msg(AF_MSG_ERROR,"[resample] The output sample frequency " |
296 "must be between 8kHz and 192kHz. Current value is %i \n", | |
297 ((int*)arg)[0]); | |
7568 | 298 return AF_ERROR; |
299 } | |
300 | |
301 af->data->rate=((int*)arg)[0]; | |
8607 | 302 af_msg(AF_MSG_VERBOSE,"[resample] Changing sample rate " |
303 "to %iHz\n",af->data->rate); | |
7568 | 304 return AF_OK; |
305 } | |
306 return AF_UNKNOWN; | |
307 } | |
308 | |
309 // Deallocate memory | |
310 static void uninit(struct af_instance_s* af) | |
311 { | |
312 if(af->data) | |
313 free(af->data); | |
314 } | |
315 | |
316 // Filter data through filter | |
317 static af_data_t* play(struct af_instance_s* af, af_data_t* data) | |
318 { | |
319 int len = 0; // Length of output data | |
320 af_data_t* c = data; // Current working data | |
321 af_data_t* l = af->data; // Local data | |
322 af_resample_t* s = (af_resample_t*)af->setup; | |
323 | |
324 if(AF_OK != RESIZE_LOCAL_BUFFER(af,data)) | |
325 return NULL; | |
326 | |
327 // Run resampling | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
328 switch(s->setup & RSMP_MASK){ |
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
329 case(RSMP_INT): |
8607 | 330 # define FORMAT_I 1 |
331 if(s->up>s->dn){ | |
332 # define UP | |
333 # include "af_resample.h" | |
334 # undef UP | |
335 } | |
336 else{ | |
337 # define DN | |
338 # include "af_resample.h" | |
339 # undef DN | |
340 } | |
341 break; | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
342 case(RSMP_FLOAT): |
8607 | 343 # undef FORMAT_I |
344 # define FORMAT_F 1 | |
345 if(s->up>s->dn){ | |
346 # define UP | |
347 # include "af_resample.h" | |
348 # undef UP | |
349 } | |
350 else{ | |
351 # define DN | |
352 # include "af_resample.h" | |
353 # undef DN | |
354 } | |
355 break; | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
356 case(RSMP_LIN): |
8607 | 357 len = linint(c, l, s); |
358 break; | |
359 } | |
7568 | 360 |
361 // Set output data | |
362 c->audio = l->audio; | |
8607 | 363 c->len = len*l->bps; |
7568 | 364 c->rate = l->rate; |
365 | |
366 return c; | |
367 } | |
368 | |
369 // Allocate memory and set function pointers | |
370 static int open(af_instance_t* af){ | |
371 af->control=control; | |
372 af->uninit=uninit; | |
373 af->play=play; | |
374 af->mul.n=1; | |
375 af->mul.d=1; | |
376 af->data=calloc(1,sizeof(af_data_t)); | |
377 af->setup=calloc(1,sizeof(af_resample_t)); | |
378 if(af->data == NULL || af->setup == NULL) | |
379 return AF_ERROR; | |
8867
558f0b1f45ee
New auto config for volume and resample and added support for float flag in configuration
anders
parents:
8711
diff
changeset
|
380 ((af_resample_t*)af->setup)->setup = RSMP_INT | FREQ_SLOPPY; |
7568 | 381 return AF_OK; |
382 } | |
383 | |
384 // Description of this plugin | |
385 af_info_t af_info_resample = { | |
386 "Sample frequency conversion", | |
387 "resample", | |
388 "Anders", | |
389 "", | |
7615 | 390 AF_FLAGS_REENTRANT, |
7568 | 391 open |
392 }; | |
393 |