annotate libaf/af_lavcresample.c @ 13755:b9bf8c83e422

sync tag bump
author wight
date Mon, 25 Oct 2004 06:02:17 +0000
parents a45e901cc870
children 1b0d5a6ab7dc
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
13713
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
1 // Copyright (c) 2004 Michael Niedermayer <michaelni@gmx.at>
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
2 // #inlcude <GPL_v2.h>
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
3
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
4 #include <stdio.h>
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
5 #include <stdlib.h>
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
6 #include <string.h>
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
7 #include <inttypes.h>
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
8
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
9 #include "../config.h"
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
10 #include "af.h"
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
11
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
12 #ifdef USE_LIBAVCODEC
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
13
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
14 #include "../libavcodec/avcodec.h"
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
15 #include "../libavcodec/rational.h"
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
16
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
17 #define CHANS 6
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
18
13730
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
19 int64_t ff_gcd(int64_t a, int64_t b);
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
20
13713
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
21 // Data for specific instances of this filter
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
22 typedef struct af_resample_s{
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
23 struct AVResampleContext *avrctx;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
24 int16_t *in[CHANS];
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
25 int in_alloc;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
26 int index;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
27
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
28 int filter_length;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
29 int linear;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
30 int phase_shift;
13730
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
31 double cutoff;
13713
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
32 }af_resample_t;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
33
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
34
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
35 // Initialization and runtime control
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
36 static int control(struct af_instance_s* af, int cmd, void* arg)
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
37 {
13730
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
38 int g;
13713
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
39 af_resample_t* s = (af_resample_t*)af->setup;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
40 af_data_t *data= (af_data_t*)arg;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
41
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
42 switch(cmd){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
43 case AF_CONTROL_REINIT:
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
44 if((af->data->rate == data->rate) || (af->data->rate == 0))
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
45 return AF_DETACH;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
46
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
47 if(data->format != (AF_FORMAT_SI | AF_FORMAT_NE) || data->nch > CHANS)
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
48 return AF_ERROR;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
49
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
50 af->data->nch = data->nch;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
51 af->data->format = AF_FORMAT_SI | AF_FORMAT_NE;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
52 af->data->bps = 2;
13730
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
53 g= ff_gcd(af->data->rate, data->rate);
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
54 af->mul.n = af->data->rate/g;
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
55 af->mul.d = data->rate/g;
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
56 af->delay = 500*s->filter_length/(double)min(af->data->rate, data->rate);
13713
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
57
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
58 if(s->avrctx) av_resample_close(s->avrctx);
13730
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
59 s->avrctx= av_resample_init(af->mul.n, /*in_rate*/af->mul.d, s->filter_length, s->phase_shift, s->linear, s->cutoff);
13713
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
60
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
61 return AF_OK;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
62 case AF_CONTROL_COMMAND_LINE:{
13730
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
63 sscanf((char*)arg,"%d:%d:%d:%d:%lf", &af->data->rate, &s->filter_length, &s->linear, &s->phase_shift, &s->cutoff);
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
64 if(s->cutoff <= 0.0) s->cutoff= max(1.0 - 1.0/s->filter_length, 0.80);
13713
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
65 return AF_OK;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
66 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
67 case AF_CONTROL_RESAMPLE_RATE | AF_CONTROL_SET:
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
68 af->data->rate = *(int*)arg;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
69 return AF_OK;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
70 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
71 return AF_UNKNOWN;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
72 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
73
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
74 // Deallocate memory
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
75 static void uninit(struct af_instance_s* af)
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
76 {
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
77 if(af->data)
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
78 free(af->data);
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
79 if(af->setup){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
80 af_resample_t *s = af->setup;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
81 if(s->avrctx) av_resample_close(s->avrctx);
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
82 free(s);
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
83 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
84 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
85
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
86 // Filter data through filter
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
87 static af_data_t* play(struct af_instance_s* af, af_data_t* data)
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
88 {
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
89 af_resample_t *s = af->setup;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
90 int i, j, consumed, ret;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
91 int16_t *in = (int16_t*)data->audio;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
92 int16_t *out;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
93 int chans = data->nch;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
94 int in_len = data->len/(2*chans);
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
95 int out_len = (in_len*af->mul.n) / af->mul.d + 10;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
96 int16_t tmp[CHANS][out_len];
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
97
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
98 if(AF_OK != RESIZE_LOCAL_BUFFER(af,data))
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
99 return NULL;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
100
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
101 out= (int16_t*)af->data->audio;
13730
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
102
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
103 out_len= min(out_len, af->data->len/(2*chans));
a45e901cc870 user selectable cutoff frequency
michael
parents: 13713
diff changeset
104
13713
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
105 if(s->in_alloc < in_len + s->index){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
106 s->in_alloc= in_len + s->index;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
107 for(i=0; i<chans; i++){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
108 s->in[i]= realloc(s->in[i], s->in_alloc*sizeof(int16_t)); //FIXME free this maybe ;)
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
109 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
110 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
111
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
112 for(j=0; j<in_len; j++){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
113 for(i=0; i<chans; i++){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
114 s->in[i][j + s->index]= *(in++);
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
115 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
116 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
117 in_len += s->index;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
118
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
119 for(i=0; i<chans; i++){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
120 ret= av_resample(s->avrctx, tmp[i], s->in[i], &consumed, in_len, out_len, i+1 == chans);
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
121 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
122 out_len= ret;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
123
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
124 s->index= in_len - consumed;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
125 for(i=0; i<chans; i++){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
126 memmove(s->in[i], s->in[i] + consumed, s->index*sizeof(int16_t));
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
127 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
128
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
129 for(j=0; j<out_len; j++){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
130 for(i=0; i<chans; i++){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
131 *(out++)= tmp[i][j];
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
132 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
133 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
134
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
135 data->audio = af->data->audio;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
136 data->len = out_len*chans*2;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
137 data->rate = af->data->rate;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
138 return data;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
139 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
140
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
141 static int open(af_instance_t* af){
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
142 af->control=control;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
143 af->uninit=uninit;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
144 af->play=play;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
145 af->mul.n=1;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
146 af->mul.d=1;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
147 af->data=calloc(1,sizeof(af_data_t));
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
148 af->setup=calloc(1,sizeof(af_resample_t));
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
149 ((af_resample_t*)af->setup)->filter_length= 16;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
150 ((af_resample_t*)af->setup)->phase_shift= 10;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
151 // ((af_resample_t*)af->setup)->setup = RSMP_INT | FREQ_SLOPPY;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
152 return AF_OK;
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
153 }
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
154
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
155 af_info_t af_info_lavcresample = {
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
156 "Sample frequency conversion using libavcodec",
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
157 "lavcresample",
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
158 "Michael Niedermayer",
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
159 "",
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
160 AF_FLAGS_REENTRANT,
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
161 open
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
162 };
28bb0f15ac91 libavcodec resampling ...
michael
parents:
diff changeset
163 #endif