198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2005 Analog Devices */ 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @file lpc_bfin.h 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @author Jean-Marc Valin 598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @brief Functions for LPC (Linear Prediction Coefficients) analysis (Blackfin version) 698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* 898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Redistribution and use in source and binary forms, with or without 998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project modification, are permitted provided that the following conditions 1098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project are met: 1198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions of source code must retain the above copyright 1398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer. 1498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions in binary form must reproduce the above copyright 1698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer in the 1798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project documentation and/or other materials provided with the distribution. 1898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Neither the name of the Xiph.org Foundation nor the names of its 2098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project contributors may be used to endorse or promote products derived from 2198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software without specific prior written permission. 2298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 2498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 2598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 2698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR 2798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 2898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 2998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 3098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 3198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 3298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 3398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 3498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 3598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define OVERRIDE_SPEEX_AUTOCORR 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid _spx_autocorr( 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectconst spx_word16_t *x, /* in: [0...n-1] samples x */ 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectspx_word16_t *ac, /* out: [0...lag-1] ac values */ 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint lag, 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint n 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ) 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t d; 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const spx_word16_t *xs; 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i, j; 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t ac0=1; 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t ac32[11], *ac32top; 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int shift, ac_shift; 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac32top = ac32+lag-1; 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int lag_1, N_lag; 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int nshift; 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project lag_1 = lag-1; 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project N_lag = n-lag_1; 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<n;j++) 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac0 = ADD32(ac0,SHR32(MULT16_16(x[j],x[j]),8)); 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac0 = ADD32(ac0,n); 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project shift = 8; 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (shift && ac0<0x40000000) 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project shift--; 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac0 <<= 1; 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac_shift = 18; 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (ac_shift && ac0<0x40000000) 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac_shift--; 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac0 <<= 1; 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project xs = x+lag-1; 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project nshift = -shift; 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __asm__ __volatile__ 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ( 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P2 = %0;\n\t" 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = P2;\n\t" /* x in I0 */ 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "B0 = P2;\n\t" /* x in B0 */ 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %3;\n\t" /* len in R0 */ 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P3 = %3;\n\t" /* len in R0 */ 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P4 = %4;\n\t" /* nb_pitch in R0 */ 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = R0 << 1;\n\t" /* number of bytes in x */ 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L0 = R1;\n\t" 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P0 = %1;\n\t" 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P1 = %2;\n\t" 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "B1 = P1;\n\t" 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4 = %5;\n\t" 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L1 = 0;\n\t" /*Disable looping on I1*/ 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "r0 = [I0++];\n\t" 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = 0;R3=0;" 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP pitch%= LC0 = P4 >> 1;\n\t" 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN pitch%=;\n\t" 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I1 = P0;\n\t" 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = A0 = 0;\n\t" 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = [I1++];\n\t" 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP inner_prod%= LC1 = P3 >> 1;\n\t" 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN inner_prod%=;\n\t" 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 += R0.L*R1.H, A0 += R0.L*R1.L (IS) || R1.L = W[I1++];\n\t" 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 += R0.H*R1.L, A0 += R0.H*R1.H (IS) || R1.H = W[I1++] || R0 = [I0++];\n\t" 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END inner_prod%=;\n\t" 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A0 = ASHIFT A0 by R4.L;\n\t" 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = ASHIFT A1 by R4.L;\n\t" 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = A0, R3 = A1;\n\t" 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "[P1--] = R2;\n\t" 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "[P1--] = R3;\n\t" 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P0 += 4;\n\t" 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END pitch%=;\n\t" 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : : "m" (xs), "m" (x), "m" (ac32top), "m" (N_lag), "m" (lag_1), "m" (nshift) 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "A0", "A1", "P0", "P1", "P2", "P3", "P4", "R0", "R1", "R2", "R3", "R4", "I0", "I1", "L0", "L1", "B0", "B1", "memory" 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ); 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project d=0; 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<n;j++) 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project d = ADD32(d,SHR32(MULT16_16(x[j],x[j]), shift)); 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac32[0] = d; 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<lag;i++) 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project d=0; 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=i;j<lag_1;j++) 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project d = ADD32(d,SHR32(MULT16_16(x[j],x[j-i]), shift)); 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (i) 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac32[i] += d; 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ac[i] = SHR32(ac32[i], ac_shift); 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 132