celt/celt.c

   1 /* Copyright (c) 2007-2008 CSIRO
   2    Copyright (c) 2007-2010 Xiph.Org Foundation
   3    Copyright (c) 2008 Gregory Maxwell
   4    Written by Jean-Marc Valin and Gregory Maxwell */
   5 /*
   6    Redistribution and use in source and binary forms, with or without
   7    modification, are permitted provided that the following conditions
   8    are met:
   9
  10    - Redistributions of source code must retain the above copyright
  11    notice, this list of conditions and the following disclaimer.
  12
  13    - Redistributions in binary form must reproduce the above copyright
  14    notice, this list of conditions and the following disclaimer in the
  15    documentation and/or other materials provided with the distribution.
  16
  17    THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  18    ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  19    LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  20    A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
  21    OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  22    EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  23    PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
  24    PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
  25    LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
  26    NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  27    SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28 */
  29
  30 #ifdef HAVE_CONFIG_H
  31 #include "config.h"
  32 #endif
  33
  34 #define CELT_C
  35
  36 #include "os_support.h"
  37 #include "mdct.h"
  38 #include <math.h>
  39 #include "celt.h"
  40 #include "pitch.h"
  41 #include "bands.h"
  42 #include "modes.h"
  43 #include "entcode.h"
  44 #include "quant_bands.h"
  45 #include "rate.h"
  46 #include "stack_alloc.h"
  47 #include "mathops.h"
  48 #include "float_cast.h"
  49 #include <stdarg.h>
  50 #include "celt_lpc.h"
  51 #include "vq.h"
  52
  53
  54 int resampling_factor(opus_int32 rate)
  55 {
  56    int ret;
  57    switch (rate)
  58    {
  59    case 48000:
  60       ret = 1;
  61       break;
  62    case 24000:
  63       ret = 2;
  64       break;
  65    case 16000:
  66       ret = 3;
  67       break;
  68    case 12000:
  69       ret = 4;
  70       break;
  71    case 8000:
  72       ret = 6;
  73       break;
  74    default:
  75 #ifndef CUSTOM_MODES
  76       celt_assert(0);
  77 #endif
  78       ret = 0;
  79       break;
  80    }
  81    return ret;
  82 }
  83
  84
  85 void comb_filter(opus_val32 *y, opus_val32 *x, int T0, int T1, int N,
  86       opus_val16 g0, opus_val16 g1, int tapset0, int tapset1,
  87       const opus_val16 *window, int overlap)
  88 {
  89    int i;
  90    /* printf ("%d %d %f %f\n", T0, T1, g0, g1); */
  91    opus_val16 g00, g01, g02, g10, g11, g12;
  92    opus_val32 x0, x1, x2, x3, x4;
  93    static const opus_val16 gains[3][3] = {
  94          {QCONST16(0.3066406250f, 15), QCONST16(0.2170410156f, 15), QCONST16(0.1296386719f, 15)},
  95          {QCONST16(0.4638671875f, 15), QCONST16(0.2680664062f, 15), QCONST16(0.f, 15)},
  96          {QCONST16(0.7998046875f, 15), QCONST16(0.1000976562f, 15), QCONST16(0.f, 15)}};
  97
  98    if (g0==0 && g1==0)
  99    {
 100       /* OPT: Happens to work without the OPUS_MOVE(), but only because the current encoder already copies x to y */
 101       if (x!=y)
 102          OPUS_MOVE(y, x, N);
 103       return;
 104    }
 105    g00 = MULT16_16_Q15(g0, gains[tapset0][0]);
 106    g01 = MULT16_16_Q15(g0, gains[tapset0][1]);
 107    g02 = MULT16_16_Q15(g0, gains[tapset0][2]);
 108    g10 = MULT16_16_Q15(g1, gains[tapset1][0]);
 109    g11 = MULT16_16_Q15(g1, gains[tapset1][1]);
 110    g12 = MULT16_16_Q15(g1, gains[tapset1][2]);
 111    x1 = x[-T1+1];
 112    x2 = x[-T1  ];
 113    x3 = x[-T1-1];
 114    x4 = x[-T1-2];
 115    for (i=0;i<overlap;i++)
 116    {
 117       opus_val16 f;
 118       x0=x[i-T1+2];
 119       f = MULT16_16_Q15(window[i],window[i]);
 120       y[i] = x[i]
 121                + MULT16_32_Q15(MULT16_16_Q15((Q15ONE-f),g00),x[i-T0])
 122                + MULT16_32_Q15(MULT16_16_Q15((Q15ONE-f),g01),ADD32(x[i-T0+1],x[i-T0-1]))
 123                + MULT16_32_Q15(MULT16_16_Q15((Q15ONE-f),g02),ADD32(x[i-T0+2],x[i-T0-2]))
 124                + MULT16_32_Q15(MULT16_16_Q15(f,g10),x2)
 125                + MULT16_32_Q15(MULT16_16_Q15(f,g11),ADD32(x1,x3))
 126                + MULT16_32_Q15(MULT16_16_Q15(f,g12),ADD32(x0,x4));
 127       x4=x3;
 128       x3=x2;
 129       x2=x1;
 130       x1=x0;
 131
 132    }
 133    if (g1==0)
 134    {
 135       /* OPT: Happens to work without the OPUS_MOVE(), but only because the current encoder already copies x to y */
 136       if (x!=y)
 137          OPUS_MOVE(y+overlap, x+overlap, N-overlap);
 138       return;
 139    }
 140    /* OPT: For machines where the movs are costly, unroll by 5 */
 141    for (;i<N;i++)
 142    {
 143       x0=x[i-T1+2];
 144       y[i] = x[i]
 145                + MULT16_32_Q15(g10,x2)
 146                + MULT16_32_Q15(g11,ADD32(x1,x3))
 147                + MULT16_32_Q15(g12,ADD32(x0,x4));
 148       x4=x3;
 149       x3=x2;
 150       x2=x1;
 151       x1=x0;
 152    }
 153 }
 154
 155 const signed char tf_select_table[4][8] = {
 156       {0, -1, 0, -1,    0,-1, 0,-1},
 157       {0, -1, 0, -2,    1, 0, 1,-1},
 158       {0, -2, 0, -3,    2, 0, 1,-1},
 159       {0, -2, 0, -3,    3, 0, 1,-1},
 160 };
 161
 162
 163 void init_caps(const CELTMode *m,int *cap,int LM,int C)
 164 {
 165    int i;
 166    for (i=0;i<m->nbEBands;i++)
 167    {
 168       int N;
 169       N=(m->eBands[i+1]-m->eBands[i])<<LM;
 170       cap[i] = (m->cache.caps[m->nbEBands*(2*LM+C-1)+i]+64)*C*N>>2;
 171    }
 172 }
 173
 174
 175
 176 const char *opus_strerror(int error)
 177 {
 178    static const char * const error_strings[8] = {
 179       "success",
 180       "invalid argument",
 181       "buffer too small",
 182       "internal error",
 183       "corrupted stream",
 184       "request not implemented",
 185       "invalid state",
 186       "memory allocation failed"
 187    };
 188    if (error > 0 || error < -7)
 189       return "unknown error";
 190    else
 191       return error_strings[-error];
 192 }
 193
 194 const char *opus_get_version_string(void)
 195 {
 196     return "libopus " OPUS_VERSION
 197 #ifdef FIXED_POINT
 198           "-fixed"
 199 #endif
 200 #ifdef FUZZING
 201           "-fuzzing"
 202 #endif
 203           ;
 204 }