annotate libaf/af_pan.c @ 14835:056446159745

Yet another fourcc for mpeg-4 (files should be made with Xvid)
author rtognimp
date Sun, 27 Feb 2005 01:03:41 +0000
parents 95bb94a930a3
children 851d10933f27
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
1 /*=============================================================================
d6f40a06867b Changes includes:
anders
parents:
diff changeset
2 //
13602
14090f7300a8 The full name of the GPL is GNU General Public License.
diego
parents: 12008
diff changeset
3 // This software has been released under the terms of the GNU General Public
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
4 // license. See http://www.gnu.org/copyleft/gpl.html for details.
d6f40a06867b Changes includes:
anders
parents:
diff changeset
5 //
d6f40a06867b Changes includes:
anders
parents:
diff changeset
6 // Copyright 2002 Anders Johansson ajh@atri.curtin.edu.au
d6f40a06867b Changes includes:
anders
parents:
diff changeset
7 //
d6f40a06867b Changes includes:
anders
parents:
diff changeset
8 //=============================================================================
d6f40a06867b Changes includes:
anders
parents:
diff changeset
9 */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
10
d6f40a06867b Changes includes:
anders
parents:
diff changeset
11 /* */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
12
d6f40a06867b Changes includes:
anders
parents:
diff changeset
13 #include <stdio.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
14 #include <stdlib.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
15
d6f40a06867b Changes includes:
anders
parents:
diff changeset
16 #include <unistd.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
17 #include <inttypes.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
18 #include <math.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
19 #include <limits.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
20
d6f40a06867b Changes includes:
anders
parents:
diff changeset
21 #include "af.h"
d6f40a06867b Changes includes:
anders
parents:
diff changeset
22
d6f40a06867b Changes includes:
anders
parents:
diff changeset
23 // Data for specific instances of this filter
d6f40a06867b Changes includes:
anders
parents:
diff changeset
24 typedef struct af_pan_s
d6f40a06867b Changes includes:
anders
parents:
diff changeset
25 {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
26 float level[AF_NCH][AF_NCH]; // Gain level for each channel
d6f40a06867b Changes includes:
anders
parents:
diff changeset
27 }af_pan_t;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
28
d6f40a06867b Changes includes:
anders
parents:
diff changeset
29 // Initialization and runtime control
d6f40a06867b Changes includes:
anders
parents:
diff changeset
30 static int control(struct af_instance_s* af, int cmd, void* arg)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
31 {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
32 af_pan_t* s = af->setup;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
33
d6f40a06867b Changes includes:
anders
parents:
diff changeset
34 switch(cmd){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
35 case AF_CONTROL_REINIT:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
36 // Sanity check
d6f40a06867b Changes includes:
anders
parents:
diff changeset
37 if(!arg) return AF_ERROR;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
38
d6f40a06867b Changes includes:
anders
parents:
diff changeset
39 af->data->rate = ((af_data_t*)arg)->rate;
14245
815f03b7cee5 removing AFMT_ dependancy
alex
parents: 13602
diff changeset
40 af->data->format = AF_FORMAT_FLOAT_NE;
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
41 af->data->bps = 4;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
42 af->mul.n = af->data->nch;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
43 af->mul.d = ((af_data_t*)arg)->nch;
14433
95bb94a930a3 always cancel down fractions (frac_t) to avoid overflows and playback
reimar
parents: 14245
diff changeset
44 af_frac_cancel(&af->mul);
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
45
d6f40a06867b Changes includes:
anders
parents:
diff changeset
46 if((af->data->format != ((af_data_t*)arg)->format) ||
d6f40a06867b Changes includes:
anders
parents:
diff changeset
47 (af->data->bps != ((af_data_t*)arg)->bps)){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
48 ((af_data_t*)arg)->format = af->data->format;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
49 ((af_data_t*)arg)->bps = af->data->bps;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
50 return AF_FALSE;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
51 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
52 return control(af,AF_CONTROL_PAN_NOUT | AF_CONTROL_SET, &af->data->nch);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
53 case AF_CONTROL_COMMAND_LINE:{
d6f40a06867b Changes includes:
anders
parents:
diff changeset
54 int nch = 0;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
55 int n = 0;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
56 char* cp = NULL;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
57 int j,k;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
58 // Read number of outputs
d6f40a06867b Changes includes:
anders
parents:
diff changeset
59 sscanf((char*)arg,"%i%n", &nch,&n);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
60 if(AF_OK != control(af,AF_CONTROL_PAN_NOUT | AF_CONTROL_SET, &nch))
d6f40a06867b Changes includes:
anders
parents:
diff changeset
61 return AF_ERROR;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
62
d6f40a06867b Changes includes:
anders
parents:
diff changeset
63 // Read pan values
d6f40a06867b Changes includes:
anders
parents:
diff changeset
64 cp = &((char*)arg)[n];
d6f40a06867b Changes includes:
anders
parents:
diff changeset
65 j = 0; k = 0;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
66 while((*cp == ':') && (k < AF_NCH)){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
67 sscanf(cp, ":%f%n" , &s->level[k][j], &n);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
68 s->level[k][j] = clamp(s->level[k][j],0.0,1.0);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
69 af_msg(AF_MSG_VERBOSE,"[pan] Pan level from channel %i to"
d6f40a06867b Changes includes:
anders
parents:
diff changeset
70 " channel %i = %f\n",j,k,s->level[k][j]);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
71 cp =&cp[n];
d6f40a06867b Changes includes:
anders
parents:
diff changeset
72 j++;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
73 if(j>=nch){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
74 j = 0;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
75 k++;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
76 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
77 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
78 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
79 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
80 case AF_CONTROL_PAN_LEVEL | AF_CONTROL_SET:{
d6f40a06867b Changes includes:
anders
parents:
diff changeset
81 int i;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
82 int ch = ((af_control_ext_t*)arg)->ch;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
83 float* level = ((af_control_ext_t*)arg)->arg;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
84 for(i=0;i<AF_NCH;i++)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
85 s->level[ch][i] = clamp(level[i],0.0,1.0);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
86 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
87 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
88 case AF_CONTROL_PAN_LEVEL | AF_CONTROL_GET:{
d6f40a06867b Changes includes:
anders
parents:
diff changeset
89 int i;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
90 int ch = ((af_control_ext_t*)arg)->ch;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
91 float* level = ((af_control_ext_t*)arg)->arg;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
92 for(i=0;i<AF_NCH;i++)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
93 level[i] = s->level[ch][i];
d6f40a06867b Changes includes:
anders
parents:
diff changeset
94 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
95 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
96 case AF_CONTROL_PAN_NOUT | AF_CONTROL_SET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
97 // Reinit must be called after this function has been called
d6f40a06867b Changes includes:
anders
parents:
diff changeset
98
d6f40a06867b Changes includes:
anders
parents:
diff changeset
99 // Sanity check
12008
8631b43c9d82 10l - replace 6 with AF_NCH
henry
parents: 8674
diff changeset
100 if(((int*)arg)[0] <= 0 || ((int*)arg)[0] > AF_NCH){
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
101 af_msg(AF_MSG_ERROR,"[pan] The number of output channels must be"
d6f40a06867b Changes includes:
anders
parents:
diff changeset
102 " between 1 and %i. Current value is %i\n",AF_NCH,((int*)arg)[0]);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
103 return AF_ERROR;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
104 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
105 af->data->nch=((int*)arg)[0];
d6f40a06867b Changes includes:
anders
parents:
diff changeset
106 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
107 case AF_CONTROL_PAN_NOUT | AF_CONTROL_GET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
108 *(int*)arg = af->data->nch;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
109 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
110 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
111 return AF_UNKNOWN;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
112 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
113
d6f40a06867b Changes includes:
anders
parents:
diff changeset
114 // Deallocate memory
d6f40a06867b Changes includes:
anders
parents:
diff changeset
115 static void uninit(struct af_instance_s* af)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
116 {
8674
93212da0032e 10l memory leak + bug fixes in ms to sample time conversion
anders
parents: 8607
diff changeset
117 if(af->data->audio)
93212da0032e 10l memory leak + bug fixes in ms to sample time conversion
anders
parents: 8607
diff changeset
118 free(af->data->audio);
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
119 if(af->data)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
120 free(af->data);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
121 if(af->setup)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
122 free(af->setup);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
123 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
124
d6f40a06867b Changes includes:
anders
parents:
diff changeset
125 // Filter data through filter
d6f40a06867b Changes includes:
anders
parents:
diff changeset
126 static af_data_t* play(struct af_instance_s* af, af_data_t* data)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
127 {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
128 af_data_t* c = data; // Current working data
d6f40a06867b Changes includes:
anders
parents:
diff changeset
129 af_data_t* l = af->data; // Local data
d6f40a06867b Changes includes:
anders
parents:
diff changeset
130 af_pan_t* s = af->setup; // Setup for this instance
d6f40a06867b Changes includes:
anders
parents:
diff changeset
131 float* in = c->audio; // Input audio data
d6f40a06867b Changes includes:
anders
parents:
diff changeset
132 float* out = NULL; // Output audio data
d6f40a06867b Changes includes:
anders
parents:
diff changeset
133 float* end = in+c->len/4; // End of loop
d6f40a06867b Changes includes:
anders
parents:
diff changeset
134 int nchi = c->nch; // Number of input channels
d6f40a06867b Changes includes:
anders
parents:
diff changeset
135 int ncho = l->nch; // Number of output channels
d6f40a06867b Changes includes:
anders
parents:
diff changeset
136 register int j,k;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
137
d6f40a06867b Changes includes:
anders
parents:
diff changeset
138 if(AF_OK != RESIZE_LOCAL_BUFFER(af,data))
d6f40a06867b Changes includes:
anders
parents:
diff changeset
139 return NULL;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
140
d6f40a06867b Changes includes:
anders
parents:
diff changeset
141 out = l->audio;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
142 // Execute panning
d6f40a06867b Changes includes:
anders
parents:
diff changeset
143 // FIXME: Too slow
d6f40a06867b Changes includes:
anders
parents:
diff changeset
144 while(in < end){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
145 for(j=0;j<ncho;j++){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
146 register float x = 0.0;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
147 register float* tin = in;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
148 for(k=0;k<nchi;k++)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
149 x += tin[k] * s->level[j][k];
d6f40a06867b Changes includes:
anders
parents:
diff changeset
150 out[j] = x;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
151 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
152 out+= ncho;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
153 in+= nchi;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
154 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
155
d6f40a06867b Changes includes:
anders
parents:
diff changeset
156 // Set output data
d6f40a06867b Changes includes:
anders
parents:
diff changeset
157 c->audio = l->audio;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
158 c->len = (c->len*af->mul.n)/af->mul.d;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
159 c->nch = l->nch;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
160
d6f40a06867b Changes includes:
anders
parents:
diff changeset
161 return c;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
162 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
163
d6f40a06867b Changes includes:
anders
parents:
diff changeset
164 // Allocate memory and set function pointers
d6f40a06867b Changes includes:
anders
parents:
diff changeset
165 static int open(af_instance_t* af){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
166 af->control=control;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
167 af->uninit=uninit;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
168 af->play=play;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
169 af->mul.n=1;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
170 af->mul.d=1;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
171 af->data=calloc(1,sizeof(af_data_t));
d6f40a06867b Changes includes:
anders
parents:
diff changeset
172 af->setup=calloc(1,sizeof(af_pan_t));
d6f40a06867b Changes includes:
anders
parents:
diff changeset
173 if(af->data == NULL || af->setup == NULL)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
174 return AF_ERROR;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
175 // Set initial pan to pass-through.
d6f40a06867b Changes includes:
anders
parents:
diff changeset
176 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
177 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
178
d6f40a06867b Changes includes:
anders
parents:
diff changeset
179 // Description of this filter
d6f40a06867b Changes includes:
anders
parents:
diff changeset
180 af_info_t af_info_pan = {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
181 "Panning audio filter",
d6f40a06867b Changes includes:
anders
parents:
diff changeset
182 "pan",
d6f40a06867b Changes includes:
anders
parents:
diff changeset
183 "Anders",
d6f40a06867b Changes includes:
anders
parents:
diff changeset
184 "",
d6f40a06867b Changes includes:
anders
parents:
diff changeset
185 AF_FLAGS_NOT_REENTRANT,
d6f40a06867b Changes includes:
anders
parents:
diff changeset
186 open
d6f40a06867b Changes includes:
anders
parents:
diff changeset
187 };