annotate libaf/af_comp.c @ 26773:7763b34ba58e

Sort alphabetically
author ben
date Sun, 18 May 2008 14:55:26 +0000
parents b2402b4f0afa
children 72d0b1444141
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: 8674
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 #include <stdio.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
12 #include <stdlib.h>
8623
440301fef3fe Added/reordered #includes to silence warnings about "implicit declaration".
rathann
parents: 8607
diff changeset
13 #include <string.h>
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
14
d6f40a06867b Changes includes:
anders
parents:
diff changeset
15 #include <inttypes.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
16 #include <math.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
17 #include <limits.h>
d6f40a06867b Changes includes:
anders
parents:
diff changeset
18
d6f40a06867b Changes includes:
anders
parents:
diff changeset
19 #include "af.h"
d6f40a06867b Changes includes:
anders
parents:
diff changeset
20
d6f40a06867b Changes includes:
anders
parents:
diff changeset
21 // Data for specific instances of this filter
d6f40a06867b Changes includes:
anders
parents:
diff changeset
22 typedef struct af_comp_s
d6f40a06867b Changes includes:
anders
parents:
diff changeset
23 {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
24 int enable[AF_NCH]; // Enable/disable / channel
d6f40a06867b Changes includes:
anders
parents:
diff changeset
25 float time[AF_NCH]; // Forgetting factor for power estimate
d6f40a06867b Changes includes:
anders
parents:
diff changeset
26 float pow[AF_NCH]; // Estimated power level [dB]
d6f40a06867b Changes includes:
anders
parents:
diff changeset
27 float tresh[AF_NCH]; // Threshold [dB]
8674
93212da0032e 10l memory leak + bug fixes in ms to sample time conversion
anders
parents: 8623
diff changeset
28 int attack[AF_NCH]; // Attack time [ms]
93212da0032e 10l memory leak + bug fixes in ms to sample time conversion
anders
parents: 8623
diff changeset
29 int release[AF_NCH]; // Release time [ms]
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
30 float ratio[AF_NCH]; // Compression ratio
d6f40a06867b Changes includes:
anders
parents:
diff changeset
31 }af_comp_t;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
32
d6f40a06867b Changes includes:
anders
parents:
diff changeset
33 // Initialization and runtime control
d6f40a06867b Changes includes:
anders
parents:
diff changeset
34 static int control(struct af_instance_s* af, int cmd, void* arg)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
35 {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
36 af_comp_t* s = (af_comp_t*)af->setup;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
37 int i;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
38
d6f40a06867b Changes includes:
anders
parents:
diff changeset
39 switch(cmd){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
40 case AF_CONTROL_REINIT:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
41 // Sanity check
d6f40a06867b Changes includes:
anders
parents:
diff changeset
42 if(!arg) return AF_ERROR;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
43
d6f40a06867b Changes includes:
anders
parents:
diff changeset
44 af->data->rate = ((af_data_t*)arg)->rate;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
45 af->data->nch = ((af_data_t*)arg)->nch;
14245
815f03b7cee5 removing AFMT_ dependancy
alex
parents: 13602
diff changeset
46 af->data->format = AF_FORMAT_FLOAT_NE;
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
47 af->data->bps = 4;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
48
d6f40a06867b Changes includes:
anders
parents:
diff changeset
49 // Time constant set to 0.1s
d6f40a06867b Changes includes:
anders
parents:
diff changeset
50 // s->alpha = (1.0/0.2)/(2.0*M_PI*(float)((af_data_t*)arg)->rate);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
51 return af_test_output(af,(af_data_t*)arg);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
52 case AF_CONTROL_COMMAND_LINE:{
d6f40a06867b Changes includes:
anders
parents:
diff changeset
53 /* float v=-10.0; */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
54 /* float vol[AF_NCH]; */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
55 /* float s=0.0; */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
56 /* float clipp[AF_NCH]; */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
57 /* int i; */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
58 /* sscanf((char*)arg,"%f:%f", &v, &s); */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
59 /* for(i=0;i<AF_NCH;i++){ */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
60 /* vol[i]=v; */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
61 /* clipp[i]=s; */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
62 /* } */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
63 /* if(AF_OK != control(af,AF_CONTROL_VOLUME_SOFTCLIP | AF_CONTROL_SET, clipp)) */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
64 /* return AF_ERROR; */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
65 /* return control(af,AF_CONTROL_VOLUME_LEVEL | AF_CONTROL_SET, vol); */
d6f40a06867b Changes includes:
anders
parents:
diff changeset
66 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
67 case AF_CONTROL_COMP_ON_OFF | AF_CONTROL_SET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
68 memcpy(s->enable,(int*)arg,AF_NCH*sizeof(int));
d6f40a06867b Changes includes:
anders
parents:
diff changeset
69 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
70 case AF_CONTROL_COMP_ON_OFF | AF_CONTROL_GET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
71 memcpy((int*)arg,s->enable,AF_NCH*sizeof(int));
d6f40a06867b Changes includes:
anders
parents:
diff changeset
72 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
73 case AF_CONTROL_COMP_THRESH | AF_CONTROL_SET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
74 return af_from_dB(AF_NCH,(float*)arg,s->tresh,20.0,-60.0,-1.0);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
75 case AF_CONTROL_COMP_THRESH | AF_CONTROL_GET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
76 return af_to_dB(AF_NCH,s->tresh,(float*)arg,10.0);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
77 case AF_CONTROL_COMP_ATTACK | AF_CONTROL_SET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
78 return af_from_ms(AF_NCH,(float*)arg,s->attack,af->data->rate,500.0,0.1);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
79 case AF_CONTROL_COMP_ATTACK | AF_CONTROL_GET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
80 return af_to_ms(AF_NCH,s->attack,(float*)arg,af->data->rate);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
81 case AF_CONTROL_COMP_RELEASE | AF_CONTROL_SET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
82 return af_from_ms(AF_NCH,(float*)arg,s->release,af->data->rate,3000.0,10.0);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
83 case AF_CONTROL_COMP_RELEASE | AF_CONTROL_GET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
84 return af_to_ms(AF_NCH,s->release,(float*)arg,af->data->rate);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
85 case AF_CONTROL_COMP_RATIO | AF_CONTROL_SET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
86 for(i=0;i<AF_NCH;i++)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
87 s->ratio[i] = clamp(((float*)arg)[i],1.0,10.0);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
88 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
89 case AF_CONTROL_COMP_RATIO | AF_CONTROL_GET:
d6f40a06867b Changes includes:
anders
parents:
diff changeset
90 for(i=0;i<AF_NCH;i++)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
91 ((float*)arg)[i] = s->ratio[i];
d6f40a06867b Changes includes:
anders
parents:
diff changeset
92 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
93 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
94 return AF_UNKNOWN;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
95 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
96
d6f40a06867b Changes includes:
anders
parents:
diff changeset
97 // Deallocate memory
d6f40a06867b Changes includes:
anders
parents:
diff changeset
98 static void uninit(struct af_instance_s* af)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
99 {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
100 if(af->data)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
101 free(af->data);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
102 if(af->setup)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
103 free(af->setup);
d6f40a06867b Changes includes:
anders
parents:
diff changeset
104 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
105
d6f40a06867b Changes includes:
anders
parents:
diff changeset
106 // Filter data through filter
d6f40a06867b Changes includes:
anders
parents:
diff changeset
107 static af_data_t* play(struct af_instance_s* af, af_data_t* data)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
108 {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
109 af_data_t* c = data; // Current working data
d6f40a06867b Changes includes:
anders
parents:
diff changeset
110 af_comp_t* s = (af_comp_t*)af->setup; // Setup for this instance
d6f40a06867b Changes includes:
anders
parents:
diff changeset
111 float* a = (float*)c->audio; // Audio data
d6f40a06867b Changes includes:
anders
parents:
diff changeset
112 int len = c->len/4; // Number of samples
d6f40a06867b Changes includes:
anders
parents:
diff changeset
113 int ch = 0; // Channel counter
d6f40a06867b Changes includes:
anders
parents:
diff changeset
114 register int nch = c->nch; // Number of channels
d6f40a06867b Changes includes:
anders
parents:
diff changeset
115 register int i = 0;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
116
d6f40a06867b Changes includes:
anders
parents:
diff changeset
117 // Compress/expand
d6f40a06867b Changes includes:
anders
parents:
diff changeset
118 for(ch = 0; ch < nch ; ch++){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
119 if(s->enable[ch]){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
120 float t = 1.0 - s->time[ch];
d6f40a06867b Changes includes:
anders
parents:
diff changeset
121 for(i=ch;i<len;i+=nch){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
122 register float x = a[i];
d6f40a06867b Changes includes:
anders
parents:
diff changeset
123 register float pow = x*x;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
124 s->pow[ch] = t*s->pow[ch] +
d6f40a06867b Changes includes:
anders
parents:
diff changeset
125 pow*s->time[ch]; // LP filter
d6f40a06867b Changes includes:
anders
parents:
diff changeset
126 if(pow < s->pow[ch]){
d6f40a06867b Changes includes:
anders
parents:
diff changeset
127 ;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
128 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
129 else{
d6f40a06867b Changes includes:
anders
parents:
diff changeset
130 ;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
131 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
132 a[i] = x;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
133 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
134 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
135 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
136 return c;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
137 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
138
d6f40a06867b Changes includes:
anders
parents:
diff changeset
139 // Allocate memory and set function pointers
22746
fd6f824ef894 Rename open to af_open so as not to conflict with a previous header definition.
diego
parents: 14245
diff changeset
140 static int af_open(af_instance_t* af){
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
141 af->control=control;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
142 af->uninit=uninit;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
143 af->play=play;
24888
b2402b4f0afa libaf: change filter input/output ratio calculations
uau
parents: 22748
diff changeset
144 af->mul=1;
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
145 af->data=calloc(1,sizeof(af_data_t));
d6f40a06867b Changes includes:
anders
parents:
diff changeset
146 af->setup=calloc(1,sizeof(af_comp_t));
d6f40a06867b Changes includes:
anders
parents:
diff changeset
147 if(af->data == NULL || af->setup == NULL)
d6f40a06867b Changes includes:
anders
parents:
diff changeset
148 return AF_ERROR;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
149 return AF_OK;
d6f40a06867b Changes includes:
anders
parents:
diff changeset
150 }
d6f40a06867b Changes includes:
anders
parents:
diff changeset
151
d6f40a06867b Changes includes:
anders
parents:
diff changeset
152 // Description of this filter
d6f40a06867b Changes includes:
anders
parents:
diff changeset
153 af_info_t af_info_comp = {
d6f40a06867b Changes includes:
anders
parents:
diff changeset
154 "Compressor/expander audio filter",
d6f40a06867b Changes includes:
anders
parents:
diff changeset
155 "comp",
d6f40a06867b Changes includes:
anders
parents:
diff changeset
156 "Anders",
d6f40a06867b Changes includes:
anders
parents:
diff changeset
157 "",
d6f40a06867b Changes includes:
anders
parents:
diff changeset
158 AF_FLAGS_NOT_REENTRANT,
22746
fd6f824ef894 Rename open to af_open so as not to conflict with a previous header definition.
diego
parents: 14245
diff changeset
159 af_open
8607
d6f40a06867b Changes includes:
anders
parents:
diff changeset
160 };