← Back to branch summary

~ubuntu-branches/ubuntu/wily/sflphone/wily

« back to all changes in this revision

Viewing changes to daemon/libs/pjproject-2.0.1/third_party/speex/libspeex/filterbank.c

  • Committer: Package Import Robot
  • Author(s): Mark Purcell
  • Date: 2014-01-28 18:23:36 UTC
  • mfrom: (1.1.11)
  • mto: This revision was merged to the branch mainline in revision 24.
  • Revision ID: package-import@ubuntu.com-20140128182336-3xenud1kbnwmf3mz
http://bugs.debian.org/735846
http://bugs.debian.org/727164
http://bugs.debian.org/718178
http://bugs.debian.org/736583
http://bugs.debian.org/722040
http://bugs.debian.org/736746
* New upstream release 
  - Fixes "New Upstream Release" (Closes: #735846)
  - Fixes "Ringtone does not stop" (Closes: #727164)
  - Fixes "[sflphone-kde] crash on startup" (Closes: #718178)
  - Fixes "sflphone GUI crashes when call is hung up" (Closes: #736583)
* Build-Depends: ensure GnuTLS 2.6
  - libucommon-dev (>= 6.0.7-1.1), libccrtp-dev (>= 2.0.6-3)
  - Fixes "FTBFS Build-Depends libgnutls{26,28}-dev" (Closes: #722040)
* Fix "boost 1.49 is going away" unversioned Build-Depends: (Closes: #736746)
* Add Build-Depends: libsndfile-dev, nepomuk-core-dev

Show diffs side-by-side

added added

removed removed

Lines of Context:
daemon/libs/pjproject-2.0.1/third_party/speex/libspeex/filterbank.c
1
 
/* Copyright (C) 2006 Jean-Marc Valin */
2
 
/**
3
 
   @file filterbank.c
4
 
   @brief Converting between psd and filterbank
5
 
 */
6
 
/*
7
 
   Redistribution and use in source and binary forms, with or without
8
 
   modification, are permitted provided that the following conditions are
9
 
   met:
10
 
 
11
 
   1. Redistributions of source code must retain the above copyright notice,
12
 
   this list of conditions and the following disclaimer.
13
 
 
14
 
   2. Redistributions in binary form must reproduce the above copyright
15
 
   notice, this list of conditions and the following disclaimer in the
16
 
   documentation and/or other materials provided with the distribution.
17
 
 
18
 
   3. The name of the author may not be used to endorse or promote products
19
 
   derived from this software without specific prior written permission.
20
 
 
21
 
   THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22
 
   IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23
 
   OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
24
 
   DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
25
 
   INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
26
 
   (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
27
 
   SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28
 
   HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
29
 
   STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
30
 
   ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31
 
   POSSIBILITY OF SUCH DAMAGE.
32
 
*/
33
 
 
34
 
#ifdef HAVE_CONFIG_H
35
 
#include "config.h"
36
 
#endif
37
 
 
38
 
#include "filterbank.h"
39
 
#include "arch.h"
40
 
#include <math.h>
41
 
#include "math_approx.h"
42
 
#include "os_support.h"
43
 
 
44
 
#ifdef FIXED_POINT
45
 
 
46
 
#define toBARK(n)   (MULT16_16(26829,spx_atan(SHR32(MULT16_16(97,n),2))) + MULT16_16(4588,spx_atan(MULT16_32_Q15(20,MULT16_16(n,n)))) + MULT16_16(3355,n))
47
 
 
48
 
#else
49
 
#define toBARK(n)   (13.1f*atan(.00074f*(n))+2.24f*atan((n)*(n)*1.85e-8f)+1e-4f*(n))
50
 
#endif
51
 
 
52
 
#define toMEL(n)    (2595.f*log10(1.f+(n)/700.f))
53
 
 
54
 
FilterBank *filterbank_new(int banks, spx_word32_t sampling, int len, int type)
55
 
{
56
 
   FilterBank *bank;
57
 
   spx_word32_t df;
58
 
   spx_word32_t max_mel, mel_interval;
59
 
   int i;
60
 
   int id1;
61
 
   int id2;
62
 
   df = DIV32(SHL32(sampling,15),MULT16_16(2,len));
63
 
   max_mel = toBARK(EXTRACT16(sampling/2));
64
 
   mel_interval = PDIV32(max_mel,banks-1);
65
 
 
66
 
   bank = (FilterBank*)speex_alloc(sizeof(FilterBank));
67
 
   bank->nb_banks = banks;
68
 
   bank->len = len;
69
 
   bank->bank_left = (int*)speex_alloc(len*sizeof(int));
70
 
   bank->bank_right = (int*)speex_alloc(len*sizeof(int));
71
 
   bank->filter_left = (spx_word16_t*)speex_alloc(len*sizeof(spx_word16_t));
72
 
   bank->filter_right = (spx_word16_t*)speex_alloc(len*sizeof(spx_word16_t));
73
 
   /* Think I can safely disable normalisation that for fixed-point (and probably float as well) */
74
 
#ifndef FIXED_POINT
75
 
   bank->scaling = (float*)speex_alloc(banks*sizeof(float));
76
 
#endif
77
 
   for (i=0;i<len;i++)
78
 
   {
79
 
      spx_word16_t curr_freq;
80
 
      spx_word32_t mel;
81
 
      spx_word16_t val;
82
 
      curr_freq = EXTRACT16(MULT16_32_P15(i,df));
83
 
      mel = toBARK(curr_freq);
84
 
      if (mel > max_mel)
85
 
         break;
86
 
#ifdef FIXED_POINT
87
 
      id1 = DIV32(mel,mel_interval);
88
 
#else
89
 
      id1 = (int)(floor(mel/mel_interval));
90
 
#endif
91
 
      if (id1>banks-2)
92
 
      {
93
 
         id1 = banks-2;
94
 
         val = Q15_ONE;
95
 
      } else {
96
 
         val = DIV32_16(mel - id1*mel_interval,EXTRACT16(PSHR32(mel_interval,15)));
97
 
      }
98
 
      id2 = id1+1;
99
 
      bank->bank_left[i] = id1;
100
 
      bank->filter_left[i] = SUB16(Q15_ONE,val);
101
 
      bank->bank_right[i] = id2;
102
 
      bank->filter_right[i] = val;
103
 
   }
104
 
 
105
 
   /* Think I can safely disable normalisation for fixed-point (and probably float as well) */
106
 
#ifndef FIXED_POINT
107
 
   for (i=0;i<bank->nb_banks;i++)
108
 
      bank->scaling[i] = 0;
109
 
   for (i=0;i<bank->len;i++)
110
 
   {
111
 
      int id = bank->bank_left[i];
112
 
      bank->scaling[id] += bank->filter_left[i];
113
 
      id = bank->bank_right[i];
114
 
      bank->scaling[id] += bank->filter_right[i];
115
 
   }
116
 
   for (i=0;i<bank->nb_banks;i++)
117
 
      bank->scaling[i] = Q15_ONE/(bank->scaling[i]);
118
 
#endif
119
 
   return bank;
120
 
}
121
 
 
122
 
void filterbank_destroy(FilterBank *bank)
123
 
{
124
 
   speex_free(bank->bank_left);
125
 
   speex_free(bank->bank_right);
126
 
   speex_free(bank->filter_left);
127
 
   speex_free(bank->filter_right);
128
 
#ifndef FIXED_POINT
129
 
   speex_free(bank->scaling);
130
 
#endif
131
 
   speex_free(bank);
132
 
}
133
 
 
134
 
void filterbank_compute_bank32(FilterBank *bank, spx_word32_t *ps, spx_word32_t *mel)
135
 
{
136
 
   int i;
137
 
   for (i=0;i<bank->nb_banks;i++)
138
 
      mel[i] = 0;
139
 
 
140
 
   for (i=0;i<bank->len;i++)
141
 
   {
142
 
      int id;
143
 
      id = bank->bank_left[i];
144
 
      mel[id] += MULT16_32_P15(bank->filter_left[i],ps[i]);
145
 
      id = bank->bank_right[i];
146
 
      mel[id] += MULT16_32_P15(bank->filter_right[i],ps[i]);
147
 
   }
148
 
   /* Think I can safely disable normalisation that for fixed-point (and probably float as well) */
149
 
#ifndef FIXED_POINT
150
 
   /*for (i=0;i<bank->nb_banks;i++)
151
 
      mel[i] = MULT16_32_P15(Q15(bank->scaling[i]),mel[i]);
152
 
   */
153
 
#endif
154
 
}
155
 
 
156
 
void filterbank_compute_psd16(FilterBank *bank, spx_word16_t *mel, spx_word16_t *ps)
157
 
{
158
 
   int i;
159
 
   for (i=0;i<bank->len;i++)
160
 
   {
161
 
      spx_word32_t tmp;
162
 
      int id1, id2;
163
 
      id1 = bank->bank_left[i];
164
 
      id2 = bank->bank_right[i];
165
 
      tmp = MULT16_16(mel[id1],bank->filter_left[i]);
166
 
      tmp += MULT16_16(mel[id2],bank->filter_right[i]);
167
 
      ps[i] = EXTRACT16(PSHR32(tmp,15));
168
 
   }
169
 
}
170
 
 
171
 
 
172
 
#ifndef FIXED_POINT
173
 
void filterbank_compute_bank(FilterBank *bank, float *ps, float *mel)
174
 
{
175
 
   int i;
176
 
   for (i=0;i<bank->nb_banks;i++)
177
 
      mel[i] = 0;
178
 
 
179
 
   for (i=0;i<bank->len;i++)
180
 
   {
181
 
      int id = bank->bank_left[i];
182
 
      mel[id] += bank->filter_left[i]*ps[i];
183
 
      id = bank->bank_right[i];
184
 
      mel[id] += bank->filter_right[i]*ps[i];
185
 
   }
186
 
   for (i=0;i<bank->nb_banks;i++)
187
 
      mel[i] *= bank->scaling[i];
188
 
}
189
 
 
190
 
void filterbank_compute_psd(FilterBank *bank, float *mel, float *ps)
191
 
{
192
 
   int i;
193
 
   for (i=0;i<bank->len;i++)
194
 
   {
195
 
      int id = bank->bank_left[i];
196
 
      ps[i] = mel[id]*bank->filter_left[i];
197
 
      id = bank->bank_right[i];
198
 
      ps[i] += mel[id]*bank->filter_right[i];
199
 
   }
200
 
}
201
 
 
202
 
void filterbank_psy_smooth(FilterBank *bank, float *ps, float *mask)
203
 
{
204
 
   /* Low freq slope: 14 dB/Bark*/
205
 
   /* High freq slope: 9 dB/Bark*/
206
 
   /* Noise vs tone: 5 dB difference */
207
 
   /* FIXME: Temporary kludge */
208
 
   float bark[100];
209
 
   int i;
210
 
   /* Assumes 1/3 Bark resolution */
211
 
   float decay_low = 0.34145f;
212
 
   float decay_high = 0.50119f;
213
 
   filterbank_compute_bank(bank, ps, bark);
214
 
   for (i=1;i<bank->nb_banks;i++)
215
 
   {
216
 
      /*float decay_high = 13-1.6*log10(bark[i-1]);
217
 
      decay_high = pow(10,(-decay_high/30.f));*/
218
 
      bark[i] = bark[i] + decay_high*bark[i-1];
219
 
   }
220
 
   for (i=bank->nb_banks-2;i>=0;i--)
221
 
   {
222
 
      bark[i] = bark[i] + decay_low*bark[i+1];
223
 
   }
224
 
   filterbank_compute_psd(bank, bark, mask);
225
 
}
226
 
 
227
 
#endif