198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2005 Jean-Marc Valin */ 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @file pseudofloat.h 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @brief Pseudo-floating point 598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * This header file provides a lightweight floating point type for 698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * use on fixed-point platforms when a large dynamic range is 798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * required. The new type is not compatible with the 32-bit IEEE format, 898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * it is not even remotely as accurate as 32-bit floats, and is not 998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * even guaranteed to produce even remotely correct results for code 1098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * other than Speex. It makes all kinds of shortcuts that are acceptable 1198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * for Speex, but may not be acceptable for your application. You're 1298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * quite welcome to reuse this code and improve it, but don't assume 1398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project * it works out of the box. Most likely, it doesn't. 1498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project */ 1598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* 1698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Redistribution and use in source and binary forms, with or without 1798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project modification, are permitted provided that the following conditions 1898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project are met: 1998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions of source code must retain the above copyright 2198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer. 2298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions in binary form must reproduce the above copyright 2498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer in the 2598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project documentation and/or other materials provided with the distribution. 2698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Neither the name of the Xiph.org Foundation nor the names of its 2898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project contributors may be used to endorse or promote products derived from 2998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software without specific prior written permission. 3098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 3298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 3398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 3498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR 3598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifndef PSEUDOFLOAT_H 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PSEUDOFLOAT_H 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "arch.h" 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "os_support.h" 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "math_approx.h" 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include <math.h> 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projecttypedef struct { 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_int16_t m; 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_int16_t e; 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} spx_float_t; 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic const spx_float_t FLOAT_ZERO = {0,0}; 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic const spx_float_t FLOAT_ONE = {16384,-14}; 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic const spx_float_t FLOAT_HALF = {16384,-15}; 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MIN(a,b) ((a)<(b)?(a):(b)) 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t PSEUDOFLOAT(spx_int32_t x) 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int e=0; 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int sign=0; 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x<0) 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project sign = 1; 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = -x; 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (x==0) 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r = {0,0}; 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e = spx_ilog2(ABS32(x))-14; 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project x = VSHR32(x, e); 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (sign) 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = -x; 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = e; 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = x; 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = e; 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_ADD(spx_float_t a, spx_float_t b) 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a.m==0) 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return b; 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else if (b.m==0) 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return a; 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if ((a).e > (b).e) 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = ((a).m>>1) + ((b).m>>MIN(15,(a).e-(b).e+1)); 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = (a).e+1; 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = ((b).m>>1) + ((a).m>>MIN(15,(b).e-(a).e+1)); 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = (b).e+1; 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m>0) 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m<16384) 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m<<=1; 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e-=1; 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m>-16384) 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m<<=1; 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e-=1; 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /*printf ("%f + %f = %f\n", REALFLOAT(a), REALFLOAT(b), REALFLOAT(r));*/ 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 13298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_SUB(spx_float_t a, spx_float_t b) 13398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 13498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 13598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a.m==0) 13698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return b; 13798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else if (b.m==0) 13898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return a; 13998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if ((a).e > (b).e) 14098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 14198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = ((a).m>>1) - ((b).m>>MIN(15,(a).e-(b).e+1)); 14298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = (a).e+1; 14398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 14498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else 14598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 14698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = ((a).m>>MIN(15,(b).e-(a).e+1)) - ((b).m>>1); 14798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = (b).e+1; 14898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 14998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m>0) 15098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 15198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m<16384) 15298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 15398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m<<=1; 15498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e-=1; 15598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 15698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 15798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m>-16384) 15898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 15998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m<<=1; 16098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e-=1; 16198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 16298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 16398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /*printf ("%f + %f = %f\n", REALFLOAT(a), REALFLOAT(b), REALFLOAT(r));*/ 16498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 16598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 16698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int FLOAT_LT(spx_float_t a, spx_float_t b) 16898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 16998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a.m==0) 17098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return b.m>0; 17198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else if (b.m==0) 17298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return a.m<0; 17398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if ((a).e > (b).e) 17498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return ((a).m>>1) < ((b).m>>MIN(15,(a).e-(b).e+1)); 17598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else 17698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return ((b).m>>1) > ((a).m>>MIN(15,(b).e-(a).e+1)); 17798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 17998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 18098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int FLOAT_GT(spx_float_t a, spx_float_t b) 18198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 18298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return FLOAT_LT(b,a); 18398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 18498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 18598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_MULT(spx_float_t a, spx_float_t b) 18698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 18798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 18898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = (spx_int16_t)((spx_int32_t)(a).m*(b).m>>15); 18998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = (a).e+(b).e+15; 19098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m>0) 19198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 19298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m<16384) 19398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 19498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m<<=1; 19598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e-=1; 19698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 19798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 19898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.m>-16384) 19998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 20098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m<<=1; 20198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e-=1; 20298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 20398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 20498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project /*printf ("%f * %f = %f\n", REALFLOAT(a), REALFLOAT(b), REALFLOAT(r));*/ 20598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 20698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 20798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 20898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_AMULT(spx_float_t a, spx_float_t b) 20998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 21098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 21198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = (spx_int16_t)((spx_int32_t)(a).m*(b).m>>15); 21298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = (a).e+(b).e+15; 21398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 21498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 21598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 21698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 21798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_SHL(spx_float_t a, int b) 21898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 21998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 22098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = a.m; 22198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = a.e+b; 22298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 22398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 22498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 22598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_int16_t FLOAT_EXTRACT16(spx_float_t a) 22698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 22798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a.e<0) 22898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return EXTRACT16((EXTEND32(a.m)+(EXTEND32(1)<<(-a.e-1)))>>-a.e); 22998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else 23098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return a.m<<a.e; 23198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 23298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_int32_t FLOAT_EXTRACT32(spx_float_t a) 23498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 23598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a.e<0) 23698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return (EXTEND32(a.m)+(EXTEND32(1)<<(-a.e-1)))>>-a.e; 23798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project else 23898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return EXTEND32(a.m)<<a.e; 23998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 24098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 24198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_int32_t FLOAT_MUL32(spx_float_t a, spx_word32_t b) 24298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 24398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return VSHR32(MULT16_32_Q15(a.m, b),-a.e-15); 24498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 24598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 24698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_MUL32U(spx_word32_t a, spx_word32_t b) 24798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 24898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int e1, e2; 24998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 25098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a==0 || b==0) 25198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 25298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return FLOAT_ZERO; 25398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 25498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e1 = spx_ilog2(ABS32(a)); 25598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a = VSHR32(a, e1-14); 25698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e2 = spx_ilog2(ABS32(b)); 25798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project b = VSHR32(b, e2-14); 25898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = MULT16_16_Q15(a,b); 25998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = e1+e2-13; 26098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 26198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 26298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 26398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Do NOT attempt to divide by a negative number */ 26498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_DIV32_FLOAT(spx_word32_t a, spx_float_t b) 26598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 26698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int e=0; 26798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 26898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a==0) 26998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 27098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return FLOAT_ZERO; 27198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 27298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e = spx_ilog2(ABS32(a))-spx_ilog2(b.m-1)-15; 27398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a = VSHR32(a, e); 27498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (ABS32(a)>=SHL32(EXTEND32(b.m-1),15)) 27598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 27698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a >>= 1; 27798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e++; 27898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 27998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = DIV32_16(a,b.m); 28098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = e-b.e; 28198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 28298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 28398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 28498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 28598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Do NOT attempt to divide by a negative number */ 28698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_DIV32(spx_word32_t a, spx_word32_t b) 28798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 28898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int e0=0,e=0; 28998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 29098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a==0) 29198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 29298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return FLOAT_ZERO; 29398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 29498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (b>32767) 29598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 29698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e0 = spx_ilog2(b)-14; 29798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project b = VSHR32(b, e0); 29898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e0 = -e0; 29998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 30098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e = spx_ilog2(ABS32(a))-spx_ilog2(b-1)-15; 30198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a = VSHR32(a, e); 30298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (ABS32(a)>=SHL32(EXTEND32(b-1),15)) 30398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 30498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a >>= 1; 30598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e++; 30698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 30798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e += e0; 30898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = DIV32_16(a,b); 30998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = e; 31098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 31198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 31298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 31398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Do NOT attempt to divide by a negative number */ 31498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_DIVU(spx_float_t a, spx_float_t b) 31598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 31698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int e=0; 31798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_int32_t num; 31898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 31998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (b.m<=0) 32098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 32198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project speex_warning_int("Attempted to divide by", b.m); 32298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return FLOAT_ONE; 32398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 32498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project num = a.m; 32598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a.m = ABS16(a.m); 32698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (a.m >= b.m) 32798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 32898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project e++; 32998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a.m >>= 1; 33098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 33198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project num = num << (15-e); 33298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = DIV32_16(num,b.m); 33398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = a.e-b.e-15+e; 33498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 33598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 33698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 33798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline spx_float_t FLOAT_SQRT(spx_float_t a) 33898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 33998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_float_t r; 34098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_int32_t m; 34198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project m = SHL32(EXTEND32(a.m), 14); 34298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e = a.e - 14; 34398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (r.e & 1) 34498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 34598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e -= 1; 34698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project m <<= 1; 34798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 34898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.e >>= 1; 34998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r.m = spx_sqrt(m); 35098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return r; 35198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 35298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 35398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 35498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 35598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define spx_float_t float 35698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_ZERO 0.f 35798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_ONE 1.f 35898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_HALF 0.5f 35998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PSEUDOFLOAT(x) (x) 36098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_MULT(a,b) ((a)*(b)) 36198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_AMULT(a,b) ((a)*(b)) 36298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_MUL32(a,b) ((a)*(b)) 36398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_DIV32(a,b) ((a)/(b)) 36498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_EXTRACT16(a) (a) 36598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_EXTRACT32(a) (a) 36698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_ADD(a,b) ((a)+(b)) 36798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_SUB(a,b) ((a)-(b)) 36898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define REALFLOAT(x) (x) 36998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_DIV32_FLOAT(a,b) ((a)/(b)) 37098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_MUL32U(a,b) ((a)*(b)) 37198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_SHL(a,b) (a) 37298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_LT(a,b) ((a)<(b)) 37398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_GT(a,b) ((a)>(b)) 37498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_DIVU(a,b) ((a)/(b)) 37598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FLOAT_SQRT(a) (spx_sqrt(a)) 37698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 37798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 37898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 37998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 380