198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Copyright 1992, 1993, 1994 by Jutta Degener and Carsten Bormann, 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Technische Universitaet Berlin 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Any use of this software is permitted provided that this notice is not 698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project removed and that neither the authors nor the Technische Universitaet Berlin 798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project are deemed to have made any representations as to the suitability of this 898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project software for any purpose nor are held responsible for any defects of 998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software. THERE IS ABSOLUTELY NO WARRANTY FOR THIS SOFTWARE. 1098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project As a matter of courtesy, the authors request to be informed about uses 1298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software has found, about bugs in this software, and about any 1398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project improvements that may be of general interest. 1498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Berlin, 28.11.1994 1698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Jutta Degener 1798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Carsten Bormann 1898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Code modified by Jean-Marc Valin 2198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Speex License: 2398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Redistribution and use in source and binary forms, with or without 2598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project modification, are permitted provided that the following conditions 2698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project are met: 2798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions of source code must retain the above copyright 2998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer. 3098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions in binary form must reproduce the above copyright 3298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer in the 3398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project documentation and/or other materials provided with the distribution. 3498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Neither the name of the Xiph.org Foundation nor the names of its 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project contributors may be used to endorse or promote products derived from 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software without specific prior written permission. 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef HAVE_CONFIG_H 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "config.h" 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "lpc.h" 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef BFIN_ASM 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "lpc_bfin.h" 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* LPC analysis 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * The next two functions calculate linear prediction coefficients 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * and/or the related reflection coefficients from the first P_MAX+1 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * values of the autocorrelation function. 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project */ 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Invented by N. Levinson in 1947, modified by J. Durbin in 1959. 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project */ 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* returns minimum mean square error */ 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectspx_word32_t _spx_lpc( 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectspx_coef_t *lpc, /* out: [0...p-1] LPC coefficients */ 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectconst spx_word16_t *ac, /* in: [0...p] autocorrelation values */ 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint p 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project) 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i, j; 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t r; 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t error = ac[0]; 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (ac[0] == 0) 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i = 0; i < p; i++) 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project lpc[i] = 0; 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 0; 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i = 0; i < p; i++) { 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Sum up this iteration's reflection coefficient */ 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t rr = NEG32(SHL32(EXTEND32(ac[i + 1]),13)); 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j = 0; j < i; j++) 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project rr = SUB32(rr,MULT16_16(lpc[j],ac[i - j])); 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r = DIV32_16(rr+PSHR32(error,1),ADD16(error,8)); 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r = rr/(error+.003*ac[0]); 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Update LPC coefficients and total error */ 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project lpc[i] = r; 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j = 0; j < i>>1; j++) 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t tmp = lpc[j]; 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project lpc[j] = MAC16_16_P13(lpc[j],r,lpc[i-1-j]); 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project lpc[i-1-j] = MAC16_16_P13(lpc[i-1-j],r,tmp); 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (i & 1) 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project lpc[j] = MAC16_16_P13(lpc[j],lpc[j],r); 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project error = SUB16(error,MULT16_16_Q13(r,MULT16_16_Q13(error,r))); 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return error; 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Compute the autocorrelation 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * ,--, 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * ac(i) = > x(n) * x(n-i) for all n 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * `--' 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * for lags between 0 and lag-1, and x == 0 outside 0...n-1 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project */ 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifndef OVERRIDE_SPEEX_AUTOCORR 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid _spx_autocorr( 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectconst spx_word16_t *x, /* in: [0...n-1] samples x */ 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectspx_word16_t *ac, /* out: [0...lag-1] ac values */ 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint lag, 13298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint n 13398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project) 13498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 13598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t d; 13698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i, j; 13798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t ac0=1; 13898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int shift, ac_shift; 13998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 14098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<n;j++) 14198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac0 = ADD32(ac0,SHR32(MULT16_16(x[j],x[j]),8)); 14298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac0 = ADD32(ac0,n); 14398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project shift = 8; 14498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (shift && ac0<0x40000000) 14598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 14698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project shift--; 14798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac0 <<= 1; 14898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 14998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac_shift = 18; 15098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (ac_shift && ac0<0x40000000) 15198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 15298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac_shift--; 15398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac0 <<= 1; 15498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 15598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 15698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 15798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<lag;i++) 15898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 15998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project d=0; 16098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=i;j<n;j++) 16198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 16298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project d = ADD32(d,SHR32(MULT16_16(x[j],x[j-i]), shift)); 16398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 16498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac[i] = SHR32(d, ac_shift); 16698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 16798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 16898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 16998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 17298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Compute the autocorrelation 17698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * ,--, 17798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * ac(i) = > x(n) * x(n-i) for all n 17898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * `--' 17998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * for lags between 0 and lag-1, and x == 0 outside 0...n-1 18098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project */ 18198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid _spx_autocorr( 18298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectconst spx_word16_t *x, /* in: [0...n-1] samples x */ 18398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectfloat *ac, /* out: [0...lag-1] ac values */ 18498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint lag, 18598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint n 18698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project) 18798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 18898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float d; 18998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 19098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (lag--) 19198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 19298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i = lag, d = 0; i < n; i++) 19398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project d += x[i] * x[i-lag]; 19498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac[lag] = d; 19598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 19698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac[0] += 10; 19798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 19898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 19998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 20098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 20198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 202