← 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/quant_lsp.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/quant_lsp.c
1
 
/* Copyright (C) 2002 Jean-Marc Valin
2
 
   File: quant_lsp.c
3
 
   LSP vector quantization
4
 
 
5
 
   Redistribution and use in source and binary forms, with or without
6
 
   modification, are permitted provided that the following conditions
7
 
   are met:
8
 
 
9
 
   - Redistributions of source code must retain the above copyright
10
 
   notice, this list of conditions and the following disclaimer.
11
 
 
12
 
   - Redistributions in binary form must reproduce the above copyright
13
 
   notice, this list of conditions and the following disclaimer in the
14
 
   documentation and/or other materials provided with the distribution.
15
 
 
16
 
   - Neither the name of the Xiph.org Foundation nor the names of its
17
 
   contributors may be used to endorse or promote products derived from
18
 
   this software without specific prior written permission.
19
 
 
20
 
   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
21
 
   ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
22
 
   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
23
 
   A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR
24
 
   CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
25
 
   EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
26
 
   PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
27
 
   PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
28
 
   LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
29
 
   NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
30
 
   SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31
 
*/
32
 
 
33
 
#ifdef HAVE_CONFIG_H
34
 
#include "config.h"
35
 
#endif
36
 
 
37
 
#include "quant_lsp.h"
38
 
#include "os_support.h"
39
 
#include <math.h>
40
 
#ifndef M_PI
41
 
#define M_PI 3.14159265358979323846
42
 
#endif
43
 
 
44
 
#include "arch.h"
45
 
 
46
 
#ifdef BFIN_ASM
47
 
#include "quant_lsp_bfin.h"
48
 
#endif
49
 
 
50
 
#ifdef FIXED_POINT
51
 
 
52
 
#define LSP_LINEAR(i) (SHL16(i+1,11))
53
 
#define LSP_LINEAR_HIGH(i) (ADD16(MULT16_16_16(i,2560),6144))
54
 
#define LSP_DIV_256(x) (SHL16((spx_word16_t)x, 5))
55
 
#define LSP_DIV_512(x) (SHL16((spx_word16_t)x, 4))
56
 
#define LSP_DIV_1024(x) (SHL16((spx_word16_t)x, 3))
57
 
#define LSP_PI 25736
58
 
 
59
 
#else
60
 
 
61
 
#define LSP_LINEAR(i) (.25*(i)+.25)
62
 
#define LSP_LINEAR_HIGH(i) (.3125*(i)+.75)
63
 
#define LSP_SCALE 256.
64
 
#define LSP_DIV_256(x) (0.0039062*(x))
65
 
#define LSP_DIV_512(x) (0.0019531*(x))
66
 
#define LSP_DIV_1024(x) (0.00097656*(x))
67
 
#define LSP_PI M_PI
68
 
 
69
 
#endif
70
 
 
71
 
static void compute_quant_weights(spx_lsp_t *qlsp, spx_word16_t *quant_weight, int order)
72
 
{
73
 
   int i;
74
 
   spx_word16_t tmp1, tmp2;
75
 
   for (i=0;i<order;i++)
76
 
   {
77
 
      if (i==0)
78
 
         tmp1 = qlsp[i];
79
 
      else
80
 
         tmp1 = qlsp[i]-qlsp[i-1];
81
 
      if (i==order-1)
82
 
         tmp2 = LSP_PI-qlsp[i];
83
 
      else
84
 
         tmp2 = qlsp[i+1]-qlsp[i];
85
 
      if (tmp2<tmp1)
86
 
         tmp1 = tmp2;
87
 
#ifdef FIXED_POINT
88
 
      quant_weight[i] = DIV32_16(81920,ADD16(300,tmp1));
89
 
#else
90
 
      quant_weight[i] = 10/(.04+tmp1);
91
 
#endif
92
 
   }
93
 
 
94
 
}
95
 
 
96
 
/* Note: x is modified*/
97
 
#ifndef OVERRIDE_LSP_QUANT
98
 
static int lsp_quant(spx_word16_t *x, const signed char *cdbk, int nbVec, int nbDim)
99
 
{
100
 
   int i,j;
101
 
   spx_word32_t dist;
102
 
   spx_word16_t tmp;
103
 
   spx_word32_t best_dist=VERY_LARGE32;
104
 
   int best_id=0;
105
 
   const signed char *ptr=cdbk;
106
 
   for (i=0;i<nbVec;i++)
107
 
   {
108
 
      dist=0;
109
 
      for (j=0;j<nbDim;j++)
110
 
      {
111
 
         tmp=SUB16(x[j],SHL16((spx_word16_t)*ptr++,5));
112
 
         dist=MAC16_16(dist,tmp,tmp);
113
 
      }
114
 
      if (dist<best_dist)
115
 
      {
116
 
         best_dist=dist;
117
 
         best_id=i;
118
 
      }
119
 
   }
120
 
 
121
 
   for (j=0;j<nbDim;j++)
122
 
      x[j] = SUB16(x[j],SHL16((spx_word16_t)cdbk[best_id*nbDim+j],5));
123
 
 
124
 
   return best_id;
125
 
}
126
 
#endif
127
 
 
128
 
/* Note: x is modified*/
129
 
#ifndef OVERRIDE_LSP_WEIGHT_QUANT
130
 
static int lsp_weight_quant(spx_word16_t *x, spx_word16_t *weight, const signed char *cdbk, int nbVec, int nbDim)
131
 
{
132
 
   int i,j;
133
 
   spx_word32_t dist;
134
 
   spx_word16_t tmp;
135
 
   spx_word32_t best_dist=VERY_LARGE32;
136
 
   int best_id=0;
137
 
   const signed char *ptr=cdbk;
138
 
   for (i=0;i<nbVec;i++)
139
 
   {
140
 
      dist=0;
141
 
      for (j=0;j<nbDim;j++)
142
 
      {
143
 
         tmp=SUB16(x[j],SHL16((spx_word16_t)*ptr++,5));
144
 
         dist=MAC16_32_Q15(dist,weight[j],MULT16_16(tmp,tmp));
145
 
      }
146
 
      if (dist<best_dist)
147
 
      {
148
 
         best_dist=dist;
149
 
         best_id=i;
150
 
      }
151
 
   }
152
 
 
153
 
   for (j=0;j<nbDim;j++)
154
 
      x[j] = SUB16(x[j],SHL16((spx_word16_t)cdbk[best_id*nbDim+j],5));
155
 
   return best_id;
156
 
}
157
 
#endif
158
 
 
159
 
void lsp_quant_nb(spx_lsp_t *lsp, spx_lsp_t *qlsp, int order, SpeexBits *bits)
160
 
{
161
 
   int i;
162
 
   int id;
163
 
   spx_word16_t quant_weight[10];
164
 
 
165
 
   for (i=0;i<order;i++)
166
 
      qlsp[i]=lsp[i];
167
 
 
168
 
   compute_quant_weights(qlsp, quant_weight, order);
169
 
 
170
 
   for (i=0;i<order;i++)
171
 
      qlsp[i]=SUB16(qlsp[i],LSP_LINEAR(i));
172
 
 
173
 
#ifndef FIXED_POINT
174
 
   for (i=0;i<order;i++)
175
 
      qlsp[i] = LSP_SCALE*qlsp[i];
176
 
#endif
177
 
   id = lsp_quant(qlsp, cdbk_nb, NB_CDBK_SIZE, order);
178
 
   speex_bits_pack(bits, id, 6);
179
 
 
180
 
   for (i=0;i<order;i++)
181
 
      qlsp[i]*=2;
182
 
 
183
 
   id = lsp_weight_quant(qlsp, quant_weight, cdbk_nb_low1, NB_CDBK_SIZE_LOW1, 5);
184
 
   speex_bits_pack(bits, id, 6);
185
 
 
186
 
   for (i=0;i<5;i++)
187
 
      qlsp[i]*=2;
188
 
 
189
 
   id = lsp_weight_quant(qlsp, quant_weight, cdbk_nb_low2, NB_CDBK_SIZE_LOW2, 5);
190
 
   speex_bits_pack(bits, id, 6);
191
 
 
192
 
   id = lsp_weight_quant(qlsp+5, quant_weight+5, cdbk_nb_high1, NB_CDBK_SIZE_HIGH1, 5);
193
 
   speex_bits_pack(bits, id, 6);
194
 
 
195
 
   for (i=5;i<10;i++)
196
 
      qlsp[i]*=2;
197
 
 
198
 
   id = lsp_weight_quant(qlsp+5, quant_weight+5, cdbk_nb_high2, NB_CDBK_SIZE_HIGH2, 5);
199
 
   speex_bits_pack(bits, id, 6);
200
 
 
201
 
#ifdef FIXED_POINT
202
 
   for (i=0;i<order;i++)
203
 
      qlsp[i]=PSHR16(qlsp[i],2);
204
 
#else
205
 
   for (i=0;i<order;i++)
206
 
      qlsp[i]=qlsp[i] * .00097656;
207
 
#endif
208
 
 
209
 
   for (i=0;i<order;i++)
210
 
      qlsp[i]=lsp[i]-qlsp[i];
211
 
}
212
 
 
213
 
void lsp_unquant_nb(spx_lsp_t *lsp, int order, SpeexBits *bits)
214
 
{
215
 
   int i, id;
216
 
   for (i=0;i<order;i++)
217
 
      lsp[i]=LSP_LINEAR(i);
218
 
 
219
 
 
220
 
   id=speex_bits_unpack_unsigned(bits, 6);
221
 
   for (i=0;i<10;i++)
222
 
      lsp[i] = ADD32(lsp[i], LSP_DIV_256(cdbk_nb[id*10+i]));
223
 
 
224
 
   id=speex_bits_unpack_unsigned(bits, 6);
225
 
   for (i=0;i<5;i++)
226
 
      lsp[i] = ADD16(lsp[i], LSP_DIV_512(cdbk_nb_low1[id*5+i]));
227
 
 
228
 
   id=speex_bits_unpack_unsigned(bits, 6);
229
 
   for (i=0;i<5;i++)
230
 
      lsp[i] = ADD32(lsp[i], LSP_DIV_1024(cdbk_nb_low2[id*5+i]));
231
 
 
232
 
   id=speex_bits_unpack_unsigned(bits, 6);
233
 
   for (i=0;i<5;i++)
234
 
      lsp[i+5] = ADD32(lsp[i+5], LSP_DIV_512(cdbk_nb_high1[id*5+i]));
235
 
 
236
 
   id=speex_bits_unpack_unsigned(bits, 6);
237
 
   for (i=0;i<5;i++)
238
 
      lsp[i+5] = ADD32(lsp[i+5], LSP_DIV_1024(cdbk_nb_high2[id*5+i]));
239
 
}
240
 
 
241
 
 
242
 
void lsp_quant_lbr(spx_lsp_t *lsp, spx_lsp_t *qlsp, int order, SpeexBits *bits)
243
 
{
244
 
   int i;
245
 
   int id;
246
 
   spx_word16_t quant_weight[10];
247
 
 
248
 
   for (i=0;i<order;i++)
249
 
      qlsp[i]=lsp[i];
250
 
 
251
 
   compute_quant_weights(qlsp, quant_weight, order);
252
 
 
253
 
   for (i=0;i<order;i++)
254
 
      qlsp[i]=SUB16(qlsp[i],LSP_LINEAR(i));
255
 
#ifndef FIXED_POINT
256
 
   for (i=0;i<order;i++)
257
 
      qlsp[i]=qlsp[i]*LSP_SCALE;
258
 
#endif
259
 
   id = lsp_quant(qlsp, cdbk_nb, NB_CDBK_SIZE, order);
260
 
   speex_bits_pack(bits, id, 6);
261
 
 
262
 
   for (i=0;i<order;i++)
263
 
      qlsp[i]*=2;
264
 
 
265
 
   id = lsp_weight_quant(qlsp, quant_weight, cdbk_nb_low1, NB_CDBK_SIZE_LOW1, 5);
266
 
   speex_bits_pack(bits, id, 6);
267
 
 
268
 
   id = lsp_weight_quant(qlsp+5, quant_weight+5, cdbk_nb_high1, NB_CDBK_SIZE_HIGH1, 5);
269
 
   speex_bits_pack(bits, id, 6);
270
 
 
271
 
#ifdef FIXED_POINT
272
 
   for (i=0;i<order;i++)
273
 
      qlsp[i] = PSHR16(qlsp[i],1);
274
 
#else
275
 
   for (i=0;i<order;i++)
276
 
      qlsp[i] = qlsp[i]*0.0019531;
277
 
#endif
278
 
 
279
 
   for (i=0;i<order;i++)
280
 
      qlsp[i]=lsp[i]-qlsp[i];
281
 
}
282
 
 
283
 
void lsp_unquant_lbr(spx_lsp_t *lsp, int order, SpeexBits *bits)
284
 
{
285
 
   int i, id;
286
 
   for (i=0;i<order;i++)
287
 
      lsp[i]=LSP_LINEAR(i);
288
 
 
289
 
 
290
 
   id=speex_bits_unpack_unsigned(bits, 6);
291
 
   for (i=0;i<10;i++)
292
 
      lsp[i] += LSP_DIV_256(cdbk_nb[id*10+i]);
293
 
 
294
 
   id=speex_bits_unpack_unsigned(bits, 6);
295
 
   for (i=0;i<5;i++)
296
 
      lsp[i] += LSP_DIV_512(cdbk_nb_low1[id*5+i]);
297
 
 
298
 
   id=speex_bits_unpack_unsigned(bits, 6);
299
 
   for (i=0;i<5;i++)
300
 
      lsp[i+5] += LSP_DIV_512(cdbk_nb_high1[id*5+i]);
301
 
 
302
 
}
303
 
 
304
 
 
305
 
#ifdef DISABLE_WIDEBAND
306
 
void lsp_quant_high(spx_lsp_t *lsp, spx_lsp_t *qlsp, int order, SpeexBits *bits)
307
 
{
308
 
   speex_fatal("Wideband and Ultra-wideband are disabled");
309
 
}
310
 
void lsp_unquant_high(spx_lsp_t *lsp, int order, SpeexBits *bits)
311
 
{
312
 
   speex_fatal("Wideband and Ultra-wideband are disabled");
313
 
}
314
 
#else
315
 
extern const signed char high_lsp_cdbk[];
316
 
extern const signed char high_lsp_cdbk2[];
317
 
 
318
 
 
319
 
void lsp_quant_high(spx_lsp_t *lsp, spx_lsp_t *qlsp, int order, SpeexBits *bits)
320
 
{
321
 
   int i;
322
 
   int id;
323
 
   spx_word16_t quant_weight[10];
324
 
 
325
 
   for (i=0;i<order;i++)
326
 
      qlsp[i]=lsp[i];
327
 
 
328
 
   compute_quant_weights(qlsp, quant_weight, order);
329
 
 
330
 
   /*   quant_weight[0] = 10/(qlsp[1]-qlsp[0]);
331
 
   quant_weight[order-1] = 10/(qlsp[order-1]-qlsp[order-2]);
332
 
   for (i=1;i<order-1;i++)
333
 
   {
334
 
      tmp1 = 10/(qlsp[i]-qlsp[i-1]);
335
 
      tmp2 = 10/(qlsp[i+1]-qlsp[i]);
336
 
      quant_weight[i] = tmp1 > tmp2 ? tmp1 : tmp2;
337
 
      }*/
338
 
 
339
 
   for (i=0;i<order;i++)
340
 
      qlsp[i]=SUB16(qlsp[i],LSP_LINEAR_HIGH(i));
341
 
#ifndef FIXED_POINT
342
 
   for (i=0;i<order;i++)
343
 
      qlsp[i] = qlsp[i]*LSP_SCALE;
344
 
#endif
345
 
   id = lsp_quant(qlsp, high_lsp_cdbk, 64, order);
346
 
   speex_bits_pack(bits, id, 6);
347
 
 
348
 
   for (i=0;i<order;i++)
349
 
      qlsp[i]*=2;
350
 
 
351
 
   id = lsp_weight_quant(qlsp, quant_weight, high_lsp_cdbk2, 64, order);
352
 
   speex_bits_pack(bits, id, 6);
353
 
 
354
 
#ifdef FIXED_POINT
355
 
   for (i=0;i<order;i++)
356
 
      qlsp[i] = PSHR16(qlsp[i],1);
357
 
#else
358
 
   for (i=0;i<order;i++)
359
 
      qlsp[i] = qlsp[i]*0.0019531;
360
 
#endif
361
 
 
362
 
   for (i=0;i<order;i++)
363
 
      qlsp[i]=lsp[i]-qlsp[i];
364
 
}
365
 
 
366
 
void lsp_unquant_high(spx_lsp_t *lsp, int order, SpeexBits *bits)
367
 
{
368
 
 
369
 
   int i, id;
370
 
   for (i=0;i<order;i++)
371
 
      lsp[i]=LSP_LINEAR_HIGH(i);
372
 
 
373
 
 
374
 
   id=speex_bits_unpack_unsigned(bits, 6);
375
 
   for (i=0;i<order;i++)
376
 
      lsp[i] += LSP_DIV_256(high_lsp_cdbk[id*order+i]);
377
 
 
378
 
 
379
 
   id=speex_bits_unpack_unsigned(bits, 6);
380
 
   for (i=0;i<order;i++)
381
 
      lsp[i] += LSP_DIV_512(high_lsp_cdbk2[id*order+i]);
382
 
}
383
 
 
384
 
#endif