198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2003 Jean-Marc Valin */ 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @file fixed_generic.h 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @brief Generic fixed-point operations 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 FIXED_GENERIC_H 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FIXED_GENERIC_H 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define QCONST16(x,bits) ((spx_word16_t)(.5+(x)*(((spx_word32_t)1)<<(bits)))) 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define QCONST32(x,bits) ((spx_word32_t)(.5+(x)*(((spx_word32_t)1)<<(bits)))) 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define NEG16(x) (-(x)) 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define NEG32(x) (-(x)) 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define EXTRACT16(x) ((spx_word16_t)(x)) 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define EXTEND32(x) ((spx_word32_t)(x)) 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SHR16(a,shift) ((a) >> (shift)) 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SHL16(a,shift) ((a) << (shift)) 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SHR32(a,shift) ((a) >> (shift)) 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SHL32(a,shift) ((a) << (shift)) 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PSHR16(a,shift) (SHR16((a)+((1<<((shift))>>1)),shift)) 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PSHR32(a,shift) (SHR32((a)+((EXTEND32(1)<<((shift))>>1)),shift)) 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define VSHR32(a, shift) (((shift)>0) ? SHR32(a, shift) : SHL32(a, -(shift))) 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SATURATE16(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x))) 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SATURATE32(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x))) 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SHR(a,shift) ((a) >> (shift)) 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SHL(a,shift) ((spx_word32_t)(a) << (shift)) 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PSHR(a,shift) (SHR((a)+((EXTEND32(1)<<((shift))>>1)),shift)) 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SATURATE(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x))) 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define ADD16(a,b) ((spx_word16_t)((spx_word16_t)(a)+(spx_word16_t)(b))) 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SUB16(a,b) ((spx_word16_t)(a)-(spx_word16_t)(b)) 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define ADD32(a,b) ((spx_word32_t)(a)+(spx_word32_t)(b)) 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SUB32(a,b) ((spx_word32_t)(a)-(spx_word32_t)(b)) 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* result fits in 16 bits */ 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16_16(a,b) ((((spx_word16_t)(a))*((spx_word16_t)(b)))) 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* (spx_word32_t)(spx_word16_t) gives TI compiler a hint that it's 16x16->32 multiply */ 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16(a,b) (((spx_word32_t)(spx_word16_t)(a))*((spx_word32_t)(spx_word16_t)(b))) 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_16(c,a,b) (ADD32((c),MULT16_16((a),(b)))) 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q12(a,b) ADD32(MULT16_16((a),SHR((b),12)), SHR(MULT16_16((a),((b)&0x00000fff)),12)) 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q13(a,b) ADD32(MULT16_16((a),SHR((b),13)), SHR(MULT16_16((a),((b)&0x00001fff)),13)) 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q14(a,b) ADD32(MULT16_16((a),SHR((b),14)), SHR(MULT16_16((a),((b)&0x00003fff)),14)) 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q11(a,b) ADD32(MULT16_16((a),SHR((b),11)), SHR(MULT16_16((a),((b)&0x000007ff)),11)) 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_32_Q11(c,a,b) ADD32(c,ADD32(MULT16_16((a),SHR((b),11)), SHR(MULT16_16((a),((b)&0x000007ff)),11))) 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_P15(a,b) ADD32(MULT16_16((a),SHR((b),15)), PSHR(MULT16_16((a),((b)&0x00007fff)),15)) 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q15(a,b) ADD32(MULT16_16((a),SHR((b),15)), SHR(MULT16_16((a),((b)&0x00007fff)),15)) 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_32_Q15(c,a,b) ADD32(c,ADD32(MULT16_16((a),SHR((b),15)), SHR(MULT16_16((a),((b)&0x00007fff)),15))) 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_16_Q11(c,a,b) (ADD32((c),SHR(MULT16_16((a),(b)),11))) 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_16_Q13(c,a,b) (ADD32((c),SHR(MULT16_16((a),(b)),13))) 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_16_P13(c,a,b) (ADD32((c),SHR(ADD32(4096,MULT16_16((a),(b))),13))) 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16_Q11_32(a,b) (SHR(MULT16_16((a),(b)),11)) 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16_Q13(a,b) (SHR(MULT16_16((a),(b)),13)) 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16_Q14(a,b) (SHR(MULT16_16((a),(b)),14)) 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16_Q15(a,b) (SHR(MULT16_16((a),(b)),15)) 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16_P13(a,b) (SHR(ADD32(4096,MULT16_16((a),(b))),13)) 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16_P14(a,b) (SHR(ADD32(8192,MULT16_16((a),(b))),14)) 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16_P15(a,b) (SHR(ADD32(16384,MULT16_16((a),(b))),15)) 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MUL_16_32_R15(a,bh,bl) ADD32(MULT16_16((a),(bh)), SHR(MULT16_16((a),(bl)),15)) 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define DIV32_16(a,b) ((spx_word16_t)(((spx_word32_t)(a))/((spx_word16_t)(b)))) 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PDIV32_16(a,b) ((spx_word16_t)(((spx_word32_t)(a)+((spx_word16_t)(b)>>1))/((spx_word16_t)(b)))) 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define DIV32(a,b) (((spx_word32_t)(a))/((spx_word32_t)(b))) 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PDIV32(a,b) (((spx_word32_t)(a)+((spx_word16_t)(b)>>1))/((spx_word32_t)(b))) 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 107