198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2006 David Rowe */ 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @file quant_lsp_bfin.h 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @author David Rowe 598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @brief Various compatibility routines for Speex (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_LSP_QUANT 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef OVERRIDE_LSP_QUANT 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Note http://gcc.gnu.org/onlinedocs/gcc/Machine-Constraints.html 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project well tell you all the magic resgister constraints used below 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for gcc in-line asm. 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic int lsp_quant( 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t *x, 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const signed char *cdbk, 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int nbVec, 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int nbDim 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project) 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int j; 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t best_dist=1<<30; 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int best_id=0; 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __asm__ __volatile__ 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ( 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" %0 = 1 (X);\n\t" /* %0: best_dist */ 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" %0 <<= 30;\n\t" 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" %1 = 0 (X);\n\t" /* %1: best_i */ 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" P2 = %3\n\t" /* P2: ptr to cdbk */ 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R5 = 0;\n\t" /* R5: best cb entry */ 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R0 = %5;\n\t" /* set up circ addr */ 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R0 <<= 1;\n\t" 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" L0 = R0;\n\t" 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" I0 = %2;\n\t" /* %2: &x[0] */ 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" B0 = %2;\n\t" 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R2.L = W [I0++];\n\t" 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" LSETUP (1f, 2f) LC0 = %4;\n\t" 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project"1: R3 = 0;\n\t" /* R3: dist */ 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" LSETUP (3f, 4f) LC1 = %5;\n\t" 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project"3: R1 = B [P2++] (X);\n\t" 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R1 <<= 5;\n\t" 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R0.L = R2.L - R1.L || R2.L = W [I0++];\n\t" 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R0 = R0.L*R0.L;\n\t" 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project"4: R3 = R3 + R0;\n\t" 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" cc =R3<%0;\n\t" 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" if cc %0=R3;\n\t" 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" if cc %1=R5;\n\t" 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project"2: R5 += 1;\n\t" 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" L0 = 0;\n\t" 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "=&d" (best_dist), "=&d" (best_id) 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "a" (x), "b" (cdbk), "a" (nbVec), "a" (nbDim) 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "I0", "P2", "R0", "R1", "R2", "R3", "R5", "L0", "B0", "A0" 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ); 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<nbDim;j++) { 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x[j] = SUB16(x[j],SHL16((spx_word16_t)cdbk[best_id*nbDim+j],5)); 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return best_id; 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define OVERRIDE_LSP_WEIGHT_QUANT 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef OVERRIDE_LSP_WEIGHT_QUANT 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Note http://gcc.gnu.org/onlinedocs/gcc/Machine-Constraints.html 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project well tell you all the magic resgister constraints used below 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for gcc in-line asm. 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic int lsp_weight_quant( 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t *x, 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t *weight, 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const signed char *cdbk, 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int nbVec, 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int nbDim 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project) 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int j; 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t best_dist=1<<30; 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int best_id=0; 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __asm__ __volatile__ 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ( 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" %0 = 1 (X);\n\t" /* %0: best_dist */ 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" %0 <<= 30;\n\t" 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" %1 = 0 (X);\n\t" /* %1: best_i */ 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" P2 = %4\n\t" /* P2: ptr to cdbk */ 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R5 = 0;\n\t" /* R5: best cb entry */ 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R0 = %6;\n\t" /* set up circ addr */ 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R0 <<= 1;\n\t" 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" L0 = R0;\n\t" 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" L1 = R0;\n\t" 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" I0 = %2;\n\t" /* %2: &x[0] */ 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" I1 = %3;\n\t" /* %3: &weight[0] */ 13298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" B0 = %2;\n\t" 13398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" B1 = %3;\n\t" 13498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 13598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" LSETUP (1f, 2f) LC0 = %5;\n\t" 13698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project"1: R3 = 0 (X);\n\t" /* R3: dist */ 13798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" LSETUP (3f, 4f) LC1 = %6;\n\t" 13898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project"3: R0.L = W [I0++] || R2.L = W [I1++];\n\t" 13998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R1 = B [P2++] (X);\n\t" 14098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R1 <<= 5;\n\t" 14198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R0.L = R0.L - R1.L;\n\t" 14298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R0 = R0.L*R0.L;\n\t" 14398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" A1 = R2.L*R0.L (M,IS);\n\t" 14498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" A1 = A1 >>> 16;\n\t" 14598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" R1 = (A1 += R2.L*R0.H) (IS);\n\t" 14698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project"4: R3 = R3 + R1;\n\t" 14798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 14898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" cc =R3<%0;\n\t" 14998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" if cc %0=R3;\n\t" 15098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" if cc %1=R5;\n\t" 15198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project"2: R5 += 1;\n\t" 15298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" L0 = 0;\n\t" 15398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project" L1 = 0;\n\t" 15498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "=&d" (best_dist), "=&d" (best_id) 15598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "a" (x), "a" (weight), "b" (cdbk), "a" (nbVec), "a" (nbDim) 15698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "I0", "I1", "P2", "R0", "R1", "R2", "R3", "R5", "A1", 15798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L0", "L1", "B0", "B1" 15898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ); 15998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<nbDim;j++) { 16198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x[j] = SUB16(x[j],SHL16((spx_word16_t)cdbk[best_id*nbDim+j],5)); 16298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 16398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return best_id; 16498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 16598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 166