198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2002 Jean-Marc Valin */ 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @file math_approx.h 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @brief Various math approximation functions for Speex 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#ifndef MATH_APPROX_H 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MATH_APPROX_H 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "arch.h" 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifndef FIXED_POINT 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define spx_sqrt sqrt 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define spx_acos acos 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define spx_exp exp 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define spx_cos_norm(x) (cos((.5f*M_PI)*(x))) 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define spx_atan atan 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** Generate a pseudo-random number */ 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t speex_rand(spx_word16_t std, spx_int32_t *seed) 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const unsigned int jflone = 0x3f800000; 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const unsigned int jflmsk = 0x007fffff; 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project union {int i; float f;} ran; 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project *seed = 1664525 * *seed + 1013904223; 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ran.i = jflone | (jflmsk & *seed); 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ran.f -= 1.5; 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 3.4642*std*ran.f; 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_int16_t spx_ilog2(spx_uint32_t x) 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int r=0; 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=(spx_int32_t)65536) 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x >>= 16; 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 16; 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=256) 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x >>= 8; 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 8; 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=16) 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x >>= 4; 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 4; 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=4) 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x >>= 2; 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 2; 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=2) 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 1; 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_int16_t spx_ilog4(spx_uint32_t x) 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int r=0; 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=(spx_int32_t)65536) 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x >>= 16; 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 8; 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=256) 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x >>= 8; 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 4; 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=16) 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x >>= 4; 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 2; 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>=4) 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r += 1; 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** Generate a pseudo-random number */ 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t speex_rand(spx_word16_t std, spx_int32_t *seed) 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t res; 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project *seed = 1664525 * *seed + 1013904223; 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = MULT16_16(EXTRACT16(SHR32(*seed,16)),std); 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return EXTRACT16(PSHR32(SUB32(res, SHR32(res, 3)),14)); 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* sqrt(x) ~= 0.22178 + 1.29227*x - 0.77070*x^2 + 0.25723*x^3 (for .25 < x < 1) */ 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/*#define C0 3634 13298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C1 21173 13398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C2 -12627 13498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C3 4215*/ 13598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 13698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* sqrt(x) ~= 0.22178 + 1.29227*x - 0.77070*x^2 + 0.25659*x^3 (for .25 < x < 1) */ 13798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C0 3634 13898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C1 21173 13998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C2 -12627 14098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C3 4204 14198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 14298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t spx_sqrt(spx_word32_t x) 14398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 14498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int k; 14598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t rt; 14698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project k = spx_ilog4(x)-6; 14798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = VSHR32(x, (k<<1)); 14898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project rt = ADD16(C0, MULT16_16_Q14(x, ADD16(C1, MULT16_16_Q14(x, ADD16(C2, MULT16_16_Q14(x, (C3))))))); 14998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project rt = VSHR32(rt,7-k); 15098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return rt; 15198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 15298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 15398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* log(x) ~= -2.18151 + 4.20592*x - 2.88938*x^2 + 0.86535*x^3 (for .5 < x < 1) */ 15498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 15598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 15698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define A1 16469 15798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define A2 2242 15898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define A3 1486 15998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t spx_acos(spx_word16_t x) 16198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 16298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int s=0; 16398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t ret; 16498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t sq; 16598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x<0) 16698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 16798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project s=1; 16898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = NEG16(x); 16998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 17098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = SUB16(16384,x); 17198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = x >> 1; 17398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project sq = MULT16_16_Q13(x, ADD16(A1, MULT16_16_Q13(x, ADD16(A2, MULT16_16_Q13(x, (A3)))))); 17498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ret = spx_sqrt(SHL32(EXTEND32(sq),13)); 17598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /*ret = spx_sqrt(67108864*(-1.6129e-04 + 2.0104e+00*f + 2.7373e-01*f*f + 1.8136e-01*f*f*f));*/ 17798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (s) 17898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ret = SUB16(25736,ret); 17998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return ret; 18098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 18198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 18298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 18398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define K1 8192 18498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define K2 -4096 18598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define K3 340 18698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define K4 -10 18798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 18898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t spx_cos(spx_word16_t x) 18998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 19098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t x2; 19198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 19298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x<12868) 19398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 19498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x2 = MULT16_16_P13(x,x); 19598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return ADD32(K1, MULT16_16_P13(x2, ADD32(K2, MULT16_16_P13(x2, ADD32(K3, MULT16_16_P13(K4, x2)))))); 19698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 19798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = SUB16(25736,x); 19898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x2 = MULT16_16_P13(x,x); 19998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return SUB32(-K1, MULT16_16_P13(x2, ADD32(K2, MULT16_16_P13(x2, ADD32(K3, MULT16_16_P13(K4, x2)))))); 20098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 20198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 20298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 20398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define L1 32767 20498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define L2 -7651 20598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define L3 8277 20698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define L4 -626 20798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 20898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t _spx_cos_pi_2(spx_word16_t x) 20998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 21098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t x2; 21198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 21298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x2 = MULT16_16_P15(x,x); 21398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return ADD16(1,MIN16(32766,ADD32(SUB16(L1,x2), MULT16_16_P15(x2, ADD32(L2, MULT16_16_P15(x2, ADD32(L3, MULT16_16_P15(L4, x2)))))))); 21498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 21598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 21698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t spx_cos_norm(spx_word32_t x) 21798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 21898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = x&0x0001ffff; 21998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>SHL32(EXTEND32(1), 16)) 22098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = SUB32(SHL32(EXTEND32(1), 17),x); 22198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x&0x00007fff) 22298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 22398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x<SHL32(EXTEND32(1), 15)) 22498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 22598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return _spx_cos_pi_2(EXTRACT16(x)); 22698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 22798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return NEG32(_spx_cos_pi_2(EXTRACT16(65536-x))); 22898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 22998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 23098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x&0x0000ffff) 23198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 0; 23298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else if (x&0x0001ffff) 23398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return -32767; 23498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else 23598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 32767; 23698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 23798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 23898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* 24098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project K0 = 1 24198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project K1 = log(2) 24298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project K2 = 3-4*log(2) 24398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project K3 = 3*log(2) - 2 24498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 24598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define D0 16384 24698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define D1 11356 24798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define D2 3726 24898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define D3 1301 24998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Input in Q11 format, output in Q16 */ 25098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word32_t spx_exp2(spx_word16_t x) 25198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 25298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int integer; 25398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t frac; 25498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project integer = SHR16(x,11); 25598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (integer>14) 25698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 0x7fffffff; 25798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else if (integer < -15) 25898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 0; 25998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project frac = SHL16(x-SHL16(integer,11),3); 26098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project frac = ADD16(D0, MULT16_16_Q14(frac, ADD16(D1, MULT16_16_Q14(frac, ADD16(D2 , MULT16_16_Q14(D3,frac)))))); 26198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return VSHR32(EXTEND32(frac), -integer-2); 26298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 26398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 26498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Input in Q11 format, output in Q16 */ 26598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word32_t spx_exp(spx_word16_t x) 26698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 26798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x>21290) 26898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 0x7fffffff; 26998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else if (x<-21290) 27098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 0; 27198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else 27298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return spx_exp2(MULT16_16_P14(23637,x)); 27398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 27498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define M1 32767 27598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define M2 -21 27698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define M3 -11943 27798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define M4 4936 27898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 27998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t spx_atan01(spx_word16_t x) 28098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 28198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return MULT16_16_P15(x, ADD32(M1, MULT16_16_P15(x, ADD32(M2, MULT16_16_P15(x, ADD32(M3, MULT16_16_P15(M4, x))))))); 28298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 28398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 28498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#undef M1 28598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#undef M2 28698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#undef M3 28798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#undef M4 28898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 28998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Input in Q15, output in Q14 */ 29098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t spx_atan(spx_word32_t x) 29198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 29298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x <= 32767) 29398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 29498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return SHR16(spx_atan01(x),1); 29598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 29698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int e = spx_ilog2(x); 29798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (e>=29) 29898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 25736; 29998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = DIV32_16(SHL32(EXTEND32(32767),29-e), EXTRACT16(SHR32(x, e-14))); 30098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return SUB16(25736, SHR16(spx_atan01(x),1)); 30198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 30298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 30398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 30498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifndef M_PI 30698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define M_PI 3.14159265358979323846 /* pi */ 30798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 30898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C1 0.9999932946f 31098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C2 -0.4999124376f 31198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C3 0.0414877472f 31298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define C4 -0.0012712095f 31398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 31498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 31598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SPX_PI_2 1.5707963268 31698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_word16_t spx_cos(spx_word16_t x) 31798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 31898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x<SPX_PI_2) 31998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 32098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x *= x; 32198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return C1 + x*(C2+x*(C3+C4*x)); 32298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 32398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = M_PI-x; 32498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x *= x; 32598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return NEG16(C1 + x*(C2+x*(C3+C4*x))); 32698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 32798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 32898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 32998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 33098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 33198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 33298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 333