198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2005 Analog Devices */ 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @file filters_bfin.h 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @brief Various analysis/synthesis filters (Blackfin version) 598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* 798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Redistribution and use in source and binary forms, with or without 898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project modification, are permitted provided that the following conditions 998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project are met: 1098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions of source code must retain the above copyright 1298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer. 1398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions in binary form must reproduce the above copyright 1598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer in the 1698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project documentation and/or other materials provided with the distribution. 1798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Neither the name of the Xiph.org Foundation nor the names of its 1998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project contributors may be used to endorse or promote products derived from 2098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software without specific prior written permission. 2198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 2398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 2498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 2598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR 2698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 2798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 2898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 2998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 3098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 3198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 3298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 3398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 3498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define OVERRIDE_NORMALIZE16 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint normalize16(const spx_sig_t *x, spx_word16_t *y, spx_sig_t max_scale, int len) 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_sig_t max_val=1; 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int sig_shift; 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __asm__ 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ( 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "%0 = 0;\n\t" 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = %1;\n\t" 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L0 = 0;\n\t" 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = [I0++];\n\t" 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP norm_max%= LC0 = %2;\n\t" 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN norm_max%=;\n\t" 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = ABS R1 || R1 = [I0++];\n\t" 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "%0 = MAX(%0, R2);\n\t" 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END norm_max%=;\n\t" 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "=&d" (max_val) 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "a" (x), "a" (len) 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "R1", "R2" 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ); 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project sig_shift=0; 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (max_val>max_scale) 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project sig_shift++; 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project max_val >>= 1; 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __asm__ __volatile__ 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ( 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = %0;\n\t" 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L0 = 0;\n\t" 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P1 = %1;\n\t" 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = [I0++];\n\t" 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP norm_shift%= LC0 = %3;\n\t" 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN norm_shift%=;\n\t" 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = ASHIFT R0 by %2.L || R0 = [I0++];\n\t" 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P1++] = R1;\n\t" 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END norm_shift%=;\n\t" 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = ASHIFT R0 by %2.L;\n\t" 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P1++] = R1;\n\t" 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : : "a" (x), "a" (y), "d" (-sig_shift), "a" (len-1) 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "I0", "L0", "P1", "R0", "R1", "memory" 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ); 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return sig_shift; 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define OVERRIDE_FILTER_MEM16 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid filter_mem16(const spx_word16_t *_x, const spx_coef_t *num, const spx_coef_t *den, spx_word16_t *_y, int N, int ord, spx_mem_t *mem, char *stack) 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project VARDECL(spx_word32_t *xy2); 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project VARDECL(spx_word32_t *numden_a); 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t *xy; 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t *numden; 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ALLOC(xy2, (N+1), spx_word32_t); 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ALLOC(numden_a, (2*ord+2), spx_word32_t); 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project xy = xy2+1; 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project numden = (spx_word16_t*) numden_a; 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<ord;i++) 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project numden[2*i] = num[i]; 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project numden[2*i+1] = den[i]; 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __asm__ __volatile__ 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ( 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Register setup */ 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" /*ord */ 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P0 = %3;\n\t" 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = P0;\n\t" 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "B0 = P0;\n\t" /* numden */ 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L0 = 0;\n\t" 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P2 = %0;\n\t" /* Fused xy */ 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I2 = P2;\n\t" 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L2 = 0;\n\t" 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P4 = %6;\n\t" /* mem */ 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P0 = %1;\n\t" /* _x */ 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P1 = %2;\n\t" /* _y */ 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* First sample */ 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = [P4++];\n\t" 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 <<= 3;\n\t" /* shift mem */ 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1.L = R1 (RND);\n\t" 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = W[P0++];\n\t" /* load x[0] */ 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1.L = R1.L + R2.L;\n\t" 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P1++] = R1;\n\t" /* store y[0] */ 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = PACK(R1.L, R2.L);\n\t" /* pack x16 and y16 */ 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "[P2] = R2;\n\t" 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Samples 1 to ord-1 (using memory) */ 13298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 += -1;\n\t" 13398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R3 = 0;\n\t" 13498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC0 = R0;\n\t" 13598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter_start%= LC0;\n\t" 13698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter_start%=;\n\t" 13798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R3 += 1;\n\t" 13898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC1 = R3;\n\t" 13998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 14098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = [P4++];\n\t" 14198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = R1;\n\t" 14298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A0 = 0;\n\t" 14398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = B0;\n\t" 14498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I2 = P2;\n\t" 14598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P2 += 4;\n\t" 14698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4 = [I0++] || R5 = [I2--];\n\t" 14798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter_start_inner%= LC1;\n\t" 14898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter_start_inner%=;\n\t" 14998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 -= R4.H*R5.H, A0 += R4.L*R5.L (IS) || R4 = [I0++] || R5 = [I2--];\n\t" 15098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter_start_inner%=;\n\t" 15198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A0 += A1;\n\t" 15298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4 = A0;\n\t" 15398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4 <<= 3;\n\t" /* shift mem */ 15498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4.L = R4 (RND);\n\t" 15598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = W[P0++];\n\t" /* load x */ 15698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4.L = R4.L + R2.L;\n\t" 15798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P1++] = R4;\n\t" /* store y */ 15898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project //"R4 <<= 2;\n\t" 15998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project //"R2 <<= 2;\n\t" 16098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = PACK(R4.L, R2.L);\n\t" /* pack x16 and y16 */ 16198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "[P2] = R2;\n\t" 16298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter_start%=;\n\t" 16498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Samples ord to N*/ 16698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" 16798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 <<= 1;\n\t" 16898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = B0;\n\t" /* numden */ 16998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 <<= 1;\n\t" 17098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L0 = R0;\n\t" 17198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" /* org */ 17398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = %4;\n\t" /* N */ 17498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = R2 - R0;\n\t" 17598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4 = [I0++];\n\t" /* numden */ 17698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC0 = R2;\n\t" 17798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P3 = R0;\n\t" 17898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 <<= 2;\n\t" 17998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 += 8;\n\t" 18098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I2 = P2;\n\t" 18198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "M0 = R0;\n\t" 18298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = A0 = 0;\n\t" 18398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R5 = [I2--];\n\t" /* load xy */ 18498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter_mid%= LC0;\n\t" 18598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter_mid%=;\n\t" 18698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter_mid_inner%= LC1=P3;\n\t" 18798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter_mid_inner%=;\n\t" 18898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 -= R4.H*R5.H, A0 += R4.L*R5.L (IS) || R4 = [I0++] || R5 = [I2--];\n\t" 18998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter_mid_inner%=;\n\t" 19098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = (A0 += A1) || I2 += M0;\n\t" 19198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = R0 << 3 || R5 = W[P0++];\n\t" /* load x */ 19298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0.L = R0 (RND);\n\t" 19398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0.L = R0.L + R5.L;\n\t" 19498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R5 = PACK(R0.L, R5.L) || W[P1++] = R0;\n\t" /* shift y | store y */ 19598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = A0 = 0 || [I2--] = R5\n\t" 19698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter_mid%=;\n\t" 19798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I2 += 4;\n\t" 19898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P2 = I2;\n\t" 19998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Update memory */ 20098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P4 = %6;\n\t" 20198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" 20298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC0 = R0;\n\t" 20398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P0 = B0;\n\t" 20498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = A0 = 0;\n\t" 20598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP mem_update%= LC0;\n\t" 20698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN mem_update%=;\n\t" 20798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I2 = P2;\n\t" 20898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = P0;\n\t" 20998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P0 += 4;\n\t" 21098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = LC0;\n\t" 21198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC1 = R0;\n\t" 21298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R5 = [I2--] || R4 = [I0++];\n\t" 21398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP mem_accum%= LC1;\n\t" 21498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN mem_accum%=;\n\t" 21598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 -= R4.H*R5.H, A0 += R4.L*R5.L (IS) || R4 = [I0++] || R5 = [I2--];\n\t" 21698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END mem_accum%=;\n\t" 21798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = (A0 += A1);\n\t" 21898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = A0 = 0 || [P4++] = R0;\n\t" 21998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END mem_update%=;\n\t" 22098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L0 = 0;\n\t" 22198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : : "m" (xy), "m" (_x), "m" (_y), "m" (numden), "m" (N), "m" (ord), "m" (mem) 22298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "A0", "A1", "R0", "R1", "R2", "R3", "R4", "R5", "P0", "P1", "P2", "P3", "P4", "B0", "I0", "I2", "L0", "L2", "M0", "memory" 22398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ); 22498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 22598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 22698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 22798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 22898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 22998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define OVERRIDE_IIR_MEM16 23098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid iir_mem16(const spx_word16_t *_x, const spx_coef_t *den, spx_word16_t *_y, int N, int ord, spx_mem_t *mem, char *stack) 23198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 23298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project VARDECL(spx_word16_t *y); 23398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t *yy; 23498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ALLOC(y, (N+2), spx_word16_t); 23698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yy = y+2; 23798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __asm__ __volatile__ 23998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ( 24098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Register setup */ 24198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" /*ord */ 24298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 24398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P1 = %3;\n\t" 24498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I1 = P1;\n\t" 24598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "B1 = P1;\n\t" 24698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L1 = 0;\n\t" 24798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 24898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P3 = %0;\n\t" 24998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I3 = P3;\n\t" 25098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L3 = 0;\n\t" 25198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 25298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P4 = %6;\n\t" 25398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P0 = %1;\n\t" 25498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P1 = %2;\n\t" 25598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 25698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* First sample */ 25798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = [P4++];\n\t" 25898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = R1 << 3 (S);\n\t" 25998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1.L = R1 (RND);\n\t" 26098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = W[P0++];\n\t" 26198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = R1 + R2;\n\t" 26298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P1++] = R1;\n\t" 26398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P3] = R1;\n\t" 26498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 26598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Samples 1 to ord-1 (using memory) */ 26698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 += -1;\n\t" 26798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R3 = 0;\n\t" 26898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC0 = R0;\n\t" 26998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter_start%= LC0;\n\t" 27098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter_start%=;\n\t" 27198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R3 += 1;\n\t" 27298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC1 = R3;\n\t" 27398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 27498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = [P4++];\n\t" 27598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = R1;\n\t" 27698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I1 = B1;\n\t" 27798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I3 = P3;\n\t" 27898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P3 += 2;\n\t" 27998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter_start_inner%= LC1;\n\t" 28098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter_start_inner%=;\n\t" 28198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4.L = W[I1++];\n\t" 28298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R5.L = W[I3--];\n\t" 28398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 -= R4.L*R5.L (IS);\n\t" 28498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter_start_inner%=;\n\t" 28598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 28698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = A1;\n\t" 28798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 <<= 3;\n\t" 28898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1.L = R1 (RND);\n\t" 28998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = W[P0++];\n\t" 29098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = R1 + R2;\n\t" 29198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P1++] = R1;\n\t" 29298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P3] = R1;\n\t" 29398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter_start%=;\n\t" 29498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 29598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Samples ord to N*/ 29698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" 29798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 <<= 1;\n\t" 29898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I1 = B1;\n\t" 29998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L1 = R0;\n\t" 30098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" 30298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = %4;\n\t" 30398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = R2 - R0;\n\t" 30498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R4.L = W[I1++];\n\t" 30598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC0 = R2;\n\t" 30698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter_mid%= LC0;\n\t" 30798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter_mid%=;\n\t" 30898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC1 = R0;\n\t" 30998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = 0;\n\t" 31098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I3 = P3;\n\t" 31198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P3 += 2;\n\t" 31298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R5.L = W[I3--];\n\t" 31398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter_mid_inner%= LC1;\n\t" 31498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter_mid_inner%=;\n\t" 31598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 -= R4.L*R5.L (IS) || R4.L = W[I1++] || R5.L = W[I3--];\n\t" 31698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter_mid_inner%=;\n\t" 31798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = A1;\n\t" 31898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = R1 << 3 || R2 = W[P0++];\n\t" 31998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1.L = R1 (RND);\n\t" 32098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = R1 + R2;\n\t" 32198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P1++] = R1;\n\t" 32298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[P3] = R1;\n\t" 32398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter_mid%=;\n\t" 32498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 32598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /* Update memory */ 32698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P4 = %6;\n\t" 32798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" 32898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC0 = R0;\n\t" 32998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P1 = B1;\n\t" 33098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP mem_update%= LC0;\n\t" 33198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN mem_update%=;\n\t" 33298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A0 = 0;\n\t" 33398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I3 = P3;\n\t" 33498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I1 = P1;\n\t" 33598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "P1 += 2;\n\t" 33698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = LC0;\n\t" 33798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC1=R0;\n\t" 33898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R5.L = W[I3--] || R4.L = W[I1++];\n\t" 33998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP mem_accum%= LC1;\n\t" 34098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN mem_accum%=;\n\t" 34198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A0 -= R4.L*R5.L (IS) || R4.L = W[I1++] || R5.L = W[I3--];\n\t" 34298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END mem_accum%=;\n\t" 34398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = A0;\n\t" 34498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "[P4++] = R0;\n\t" 34598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END mem_update%=;\n\t" 34698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L1 = 0;\n\t" 34798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : : "m" (yy), "m" (_x), "m" (_y), "m" (den), "m" (N), "m" (ord), "m" (mem) 34898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "A0", "A1", "R0", "R1", "R2", "R3", "R4", "R5", "P0", "P1", "P2", "P3", "P4", "B1", "I1", "I3", "L1", "L3", "memory" 34998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ); 35098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 35198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 35298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 35398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 35498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define OVERRIDE_FIR_MEM16 35598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid fir_mem16(const spx_word16_t *x, const spx_coef_t *num, spx_word16_t *y, int N, int ord, spx_mem_t *mem, char *stack) 35698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 35798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 35898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_coef_t den2[12]; 35998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_coef_t *den; 36098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project den = (spx_coef_t*)((((int)den2)+4)&0xfffffffc); 36198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<10;i++) 36298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project den[i] = 0; 36398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project filter_mem16(x, num, den, y, N, ord, mem, stack); 36498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 36598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 36698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 36798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define OVERRIDE_COMPUTE_IMPULSE_RESPONSE 36898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid compute_impulse_response(const spx_coef_t *ak, const spx_coef_t *awk1, const spx_coef_t *awk2, spx_word16_t *y, int N, int ord, char *stack) 36998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 37098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 37198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project VARDECL(spx_word16_t *ytmp); 37298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ALLOC(ytmp, N, spx_word16_t); 37398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t *ytmp2 = ytmp; 37498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[0] = LPC_SCALING; 37598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<ord;i++) 37698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[i+1] = awk1[i]; 37798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project i++; 37898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (;i<N;i++) 37998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[i] = 0; 38098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 38198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project N-=1; 38298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __asm__ __volatile__ 38398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ( 38498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = %0;\n\t" 38598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I1 = %1;\n\t" 38698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L0 = 0;\n\t" 38798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L1 = 0;\n\t" 38898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L2 = 0;\n\t" 38998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "L3 = 0;\n\t" 39098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = 1;\n\t" 39198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 <<= 13;\n\t" 39298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[I0] = R0.L;\n\t" 39398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 <<= 1;\n\t" 39498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[I1] = R0.L;\n\t" 39598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = %5;\n\t" 39698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC0 = R0;\n\t" 39798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = 0;\n\t" 39898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP samples%= LC0;\n\t" 39998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN samples%=;\n\t" 40098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 += 1;\n\t" 40198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R2 = MIN(R2, %4);\n\t" 40298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I0 = %0;\n\t" 40398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I1 = %1;\n\t" 40498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I2 = %2;\n\t" 40598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "I3 = %3;\n\t" 40698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "%0 += 2;\n\t" 40798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "%1 += 2;\n\t" 40898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 = A0 = 0;\n\t" 40998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0.L = W[I0--] || R1.L = W[I2++];\n\t" 41098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LC1 = R2;\n\t" 41198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP filter%= LC1;\n\t" 41298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_BEGIN filter%=;\n\t" 41398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A0 -= R0.L*R1.L (IS) || R0.L = W[I1--] || R1.L = W[I3++];\n\t" 41498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "A1 -= R0.L*R1.L (IS) || R0.L = W[I0--] || R1.L = W[I2++];\n\t" 41598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END filter%=;\n\t" 41698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = A0, R1 = A1;\n\t" 41798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R3 = W[%1] (X);\n\t" 41898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R3 <<= 13;\n\t" 41998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 = R0 + R3;\n\t" 42098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R3 = R0 >>> 13;\n\t" 42198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[%0] = R3.L;\n\t" 42298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R0 <<= 1;\n\t" 42398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 = R1 + R0;\n\t" 42498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "R1 >>>= 13;\n\t" 42598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "W[%1] = R1.L;\n\t" 42698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project "LOOP_END samples%=;\n\t" 42798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "=a" (ytmp2), "=a" (y) 42898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "a" (awk2), "a" (ak), "d" (ord), "m" (N), "0" (ytmp2), "1" (y) 42998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project : "A0", "A1", "R0", "R1", "R2", "R3", "I0", "I1", "I2", "I3", "L0", "L1", "L2", "L3", "A0", "A1" 43098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ); 43198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 43298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 43398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 43498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 43598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#if 0 /* Equivalent C function for filter_mem2 and compute_impulse_response */ 43698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define min(a,b) ((a)<(b) ? (a):(b)) 43798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 43898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid compute_impulse_response(const spx_coef_t *ak, const spx_coef_t *awk1, const spx_coef_t *awk2, spx_word16_t *y, int N, int ord, char *stack) 43998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 44098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i,j; 44198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project VARDECL(spx_word16_t *ytmp); 44298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ALLOC(ytmp, N, spx_word16_t); 44398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 44498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[0] = LPC_SCALING; 44598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<ord;i++) 44698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[i+1] = awk1[i]; 44798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project i++; 44898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (;i<N;i++) 44998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[i] = 0; 45098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 45198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<N;i++) 45298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 45398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t yi = SHL32(EXTEND32(y[i]),LPC_SHIFT); 45498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t yi2 = 0; 45598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<min(i,ord);j++) 45698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 45798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yi = MAC16_16(yi, awk2[j], -ytmp[i-j-1]); 45898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yi2 = MAC16_16(yi2, ak[j], -y[i-j-1]); 45998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 46098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ytmp[i] = EXTRACT16(SHR32(yi,LPC_SHIFT)); 46198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yi2 = ADD32(yi2,SHL32(yi,1)); 46298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[i] = EXTRACT16(SHR32(yi2,LPC_SHIFT)); 46398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 46498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 46598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 46698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 46798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 46898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid filter_mem2(const spx_sig_t *_x, const spx_coef_t *num, const spx_coef_t *den, spx_sig_t *_y, int N, int ord, spx_mem_t *mem) 46998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 47098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i,j; 47198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t xi,yi,nyi; 47298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t x[N],y[N]; 47398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t *xx, *yy; 47498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project xx = x; 47598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yy = y; 47698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<N;i++) 47798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 47898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x[i] = EXTRACT16(SHR32(_x[i],SIG_SHIFT)); 47998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 48098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 48198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<ord;i++) 48298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 48398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t yi = mem[i]; 48498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<i;j++) 48598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 48698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yi = MAC16_16(yi, num[j], x[i-j-1]); 48798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yi = MAC16_16(yi, den[j], -y[i-j-1]); 48898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 48998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project _y[i] = ADD32(_x[i],SHL32(yi,1)); 49098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[i] = EXTRACT16(SHR32(_y[i],SIG_SHIFT)); 49198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 49298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=ord;i<N;i++) 49398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 49498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t yi = 0; 49598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<ord;j++) 49698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 49798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yi = MAC16_16(yi, num[j], x[i-j-1]); 49898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project yi = MAC16_16(yi, den[j], -y[i-j-1]); 49998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 50098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project _y[i] = ADD32(_x[i],SHL32(yi,1)); 50198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project y[i] = EXTRACT16(SHR32(_y[i],SIG_SHIFT)); 50298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 50398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 50498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<ord;i++) 50598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 50698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mem_t m = 0; 50798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<ord-i;j++) 50898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 50998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project m = MAC16_16(m, x[N-1-j], num[j+i]); 51098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project m = MAC16_16(m, -y[N-1-j], den[j+i]); 51198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 51298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project mem[i] = m; 51398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 51498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 51598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 516