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 #ifndef PACKAGE_VERSION 54 #define PACKAGE_VERSION "unknown" 55 #endif 56 57 #if defined(MIPSr1_ASM) 58 #include "mips/celt_mipsr1.h" 59 #endif 60 61 62 int resampling_factor(opus_int32 rate) 63 { 64 int ret; 65 switch (rate) 66 { 67 case 48000: 68 ret = 1; 69 break; 70 case 24000: 71 ret = 2; 72 break; 73 case 16000: 74 ret = 3; 75 break; 76 case 12000: 77 ret = 4; 78 break; 79 case 8000: 80 ret = 6; 81 break; 82 default: 83 #ifndef CUSTOM_MODES 84 celt_assert(0); 85 #endif 86 ret = 0; 87 break; 88 } 89 return ret; 90 } 91 92 #if !defined(OVERRIDE_COMB_FILTER_CONST) || defined(NON_STATIC_COMB_FILTER_CONST_C) 93 /* This version should be faster on ARM */ 94 #ifdef OPUS_ARM_ASM 95 #ifndef NON_STATIC_COMB_FILTER_CONST_C 96 static 97 #endif 98 void comb_filter_const_c(opus_val32 *y, opus_val32 *x, int T, int N, 99 opus_val16 g10, opus_val16 g11, opus_val16 g12) 100 { 101 opus_val32 x0, x1, x2, x3, x4; 102 int i; 103 x4 = SHL32(x[-T-2], 1); 104 x3 = SHL32(x[-T-1], 1); 105 x2 = SHL32(x[-T], 1); 106 x1 = SHL32(x[-T+1], 1); 107 for (i=0;i<N-4;i+=5) 108 { 109 opus_val32 t; 110 x0=SHL32(x[i-T+2],1); 111 t = MAC16_32_Q16(x[i], g10, x2); 112 t = MAC16_32_Q16(t, g11, ADD32(x1,x3)); 113 t = MAC16_32_Q16(t, g12, ADD32(x0,x4)); 114 y[i] = t; 115 x4=SHL32(x[i-T+3],1); 116 t = MAC16_32_Q16(x[i+1], g10, x1); 117 t = MAC16_32_Q16(t, g11, ADD32(x0,x2)); 118 t = MAC16_32_Q16(t, g12, ADD32(x4,x3)); 119 y[i+1] = t; 120 x3=SHL32(x[i-T+4],1); 121 t = MAC16_32_Q16(x[i+2], g10, x0); 122 t = MAC16_32_Q16(t, g11, ADD32(x4,x1)); 123 t = MAC16_32_Q16(t, g12, ADD32(x3,x2)); 124 y[i+2] = t; 125 x2=SHL32(x[i-T+5],1); 126 t = MAC16_32_Q16(x[i+3], g10, x4); 127 t = MAC16_32_Q16(t, g11, ADD32(x3,x0)); 128 t = MAC16_32_Q16(t, g12, ADD32(x2,x1)); 129 y[i+3] = t; 130 x1=SHL32(x[i-T+6],1); 131 t = MAC16_32_Q16(x[i+4], g10, x3); 132 t = MAC16_32_Q16(t, g11, ADD32(x2,x4)); 133 t = MAC16_32_Q16(t, g12, ADD32(x1,x0)); 134 y[i+4] = t; 135 } 136 #ifdef CUSTOM_MODES 137 for (;i<N;i++) 138 { 139 opus_val32 t; 140 x0=SHL32(x[i-T+2],1); 141 t = MAC16_32_Q16(x[i], g10, x2); 142 t = MAC16_32_Q16(t, g11, ADD32(x1,x3)); 143 t = MAC16_32_Q16(t, g12, ADD32(x0,x4)); 144 y[i] = t; 145 x4=x3; 146 x3=x2; 147 x2=x1; 148 x1=x0; 149 } 150 #endif 151 } 152 #else 153 #ifndef NON_STATIC_COMB_FILTER_CONST_C 154 static 155 #endif 156 void comb_filter_const_c(opus_val32 *y, opus_val32 *x, int T, int N, 157 opus_val16 g10, opus_val16 g11, opus_val16 g12) 158 { 159 opus_val32 x0, x1, x2, x3, x4; 160 int i; 161 x4 = x[-T-2]; 162 x3 = x[-T-1]; 163 x2 = x[-T]; 164 x1 = x[-T+1]; 165 for (i=0;i<N;i++) 166 { 167 x0=x[i-T+2]; 168 y[i] = x[i] 169 + MULT16_32_Q15(g10,x2) 170 + MULT16_32_Q15(g11,ADD32(x1,x3)) 171 + MULT16_32_Q15(g12,ADD32(x0,x4)); 172 x4=x3; 173 x3=x2; 174 x2=x1; 175 x1=x0; 176 } 177 178 } 179 #endif 180 #endif 181 182 #ifndef OVERRIDE_comb_filter 183 void comb_filter(opus_val32 *y, opus_val32 *x, int T0, int T1, int N, 184 opus_val16 g0, opus_val16 g1, int tapset0, int tapset1, 185 const opus_val16 *window, int overlap, int arch) 186 { 187 int i; 188 /* printf ("%d %d %f %f\n", T0, T1, g0, g1); */ 189 opus_val16 g00, g01, g02, g10, g11, g12; 190 opus_val32 x0, x1, x2, x3, x4; 191 static const opus_val16 gains[3][3] = { 192 {QCONST16(0.3066406250f, 15), QCONST16(0.2170410156f, 15), QCONST16(0.1296386719f, 15)}, 193 {QCONST16(0.4638671875f, 15), QCONST16(0.2680664062f, 15), QCONST16(0.f, 15)}, 194 {QCONST16(0.7998046875f, 15), QCONST16(0.1000976562f, 15), QCONST16(0.f, 15)}}; 195 196 if (g0==0 && g1==0) 197 { 198 /* OPT: Happens to work without the OPUS_MOVE(), but only because the current encoder already copies x to y */ 199 if (x!=y) 200 OPUS_MOVE(y, x, N); 201 return; 202 } 203 g00 = MULT16_16_P15(g0, gains[tapset0][0]); 204 g01 = MULT16_16_P15(g0, gains[tapset0][1]); 205 g02 = MULT16_16_P15(g0, gains[tapset0][2]); 206 g10 = MULT16_16_P15(g1, gains[tapset1][0]); 207 g11 = MULT16_16_P15(g1, gains[tapset1][1]); 208 g12 = MULT16_16_P15(g1, gains[tapset1][2]); 209 x1 = x[-T1+1]; 210 x2 = x[-T1 ]; 211 x3 = x[-T1-1]; 212 x4 = x[-T1-2]; 213 /* If the filter didn't change, we don't need the overlap */ 214 if (g0==g1 && T0==T1 && tapset0==tapset1) 215 overlap=0; 216 for (i=0;i<overlap;i++) 217 { 218 opus_val16 f; 219 x0=x[i-T1+2]; 220 f = MULT16_16_Q15(window[i],window[i]); 221 y[i] = x[i] 222 + MULT16_32_Q15(MULT16_16_Q15((Q15ONE-f),g00),x[i-T0]) 223 + MULT16_32_Q15(MULT16_16_Q15((Q15ONE-f),g01),ADD32(x[i-T0+1],x[i-T0-1])) 224 + MULT16_32_Q15(MULT16_16_Q15((Q15ONE-f),g02),ADD32(x[i-T0+2],x[i-T0-2])) 225 + MULT16_32_Q15(MULT16_16_Q15(f,g10),x2) 226 + MULT16_32_Q15(MULT16_16_Q15(f,g11),ADD32(x1,x3)) 227 + MULT16_32_Q15(MULT16_16_Q15(f,g12),ADD32(x0,x4)); 228 x4=x3; 229 x3=x2; 230 x2=x1; 231 x1=x0; 232 233 } 234 if (g1==0) 235 { 236 /* OPT: Happens to work without the OPUS_MOVE(), but only because the current encoder already copies x to y */ 237 if (x!=y) 238 OPUS_MOVE(y+overlap, x+overlap, N-overlap); 239 return; 240 } 241 242 /* Compute the part with the constant filter. */ 243 comb_filter_const(y+i, x+i, T1, N-i, g10, g11, g12, arch); 244 } 245 #endif /* OVERRIDE_comb_filter */ 246 247 const signed char tf_select_table[4][8] = { 248 {0, -1, 0, -1, 0,-1, 0,-1}, 249 {0, -1, 0, -2, 1, 0, 1,-1}, 250 {0, -2, 0, -3, 2, 0, 1,-1}, 251 {0, -2, 0, -3, 3, 0, 1,-1}, 252 }; 253 254 255 void init_caps(const CELTMode *m,int *cap,int LM,int C) 256 { 257 int i; 258 for (i=0;i<m->nbEBands;i++) 259 { 260 int N; 261 N=(m->eBands[i+1]-m->eBands[i])<<LM; 262 cap[i] = (m->cache.caps[m->nbEBands*(2*LM+C-1)+i]+64)*C*N>>2; 263 } 264 } 265 266 267 268 const char *opus_strerror(int error) 269 { 270 static const char * const error_strings[8] = { 271 "success", 272 "invalid argument", 273 "buffer too small", 274 "internal error", 275 "corrupted stream", 276 "request not implemented", 277 "invalid state", 278 "memory allocation failed" 279 }; 280 if (error > 0 || error < -7) 281 return "unknown error"; 282 else 283 return error_strings[-error]; 284 } 285 286 const char *opus_get_version_string(void) 287 { 288 return "libopus " PACKAGE_VERSION 289 /* Applications may rely on the presence of this substring in the version 290 string to determine if they have a fixed-point or floating-point build 291 at runtime. */ 292 #ifdef FIXED_POINT 293 "-fixed" 294 #endif 295 #ifdef FUZZING 296 "-fuzzing" 297 #endif 298 ; 299 } 300