198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2003 Jean-Marc Valin */ 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @file fixed_debug.h 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @brief Fixed-point operations with debugging 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_DEBUG_H 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define FIXED_DEBUG_H 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include <stdio.h> 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectextern long long spx_mips; 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MIPS_INC spx_mips++, 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define QCONST16(x,bits) ((spx_word16_t)(.5+(x)*(((spx_word32_t)1)<<(bits)))) 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define QCONST32(x,bits) ((spx_word32_t)(.5+(x)*(((spx_word32_t)1)<<(bits)))) 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define VERIFY_SHORT(x) ((x)<=32767&&(x)>=-32768) 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define VERIFY_INT(x) ((x)<=2147483647LL&&(x)>=-2147483648LL) 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short NEG16(int x) 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int res; 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(x)) 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "NEG16: input is not short: %d\n", (int)x); 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = -x; 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "NEG16: output is not short: %d\n", (int)res); 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int NEG32(long long x) 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(x)) 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "NEG16: input is not int: %d\n", (int)x); 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = -x; 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "NEG16: output is not int: %d\n", (int)res); 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define EXTRACT16(x) _EXTRACT16(x, __FILE__, __LINE__) 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short _EXTRACT16(int x, char *file, int line) 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int res; 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(x)) 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "EXTRACT16: input is not short: %d in %s: line %d\n", x, file, line); 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = x; 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define EXTEND32(x) _EXTEND32(x, __FILE__, __LINE__) 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int _EXTEND32(int x, char *file, int line) 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int res; 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(x)) 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "EXTEND32: input is not short: %d in %s: line %d\n", x, file, line); 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = x; 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SHR16(a, shift) _SHR16(a, shift, __FILE__, __LINE__) 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short _SHR16(int a, int shift, char *file, int line) 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int res; 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(shift)) 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SHR16: inputs are not short: %d >> %d in %s: line %d\n", a, shift, file, line); 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a>>shift; 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SHR16: output is not short: %d in %s: line %d\n", res, file, line); 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SHL16(a, shift) _SHL16(a, shift, __FILE__, __LINE__) 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short _SHL16(int a, int shift, char *file, int line) 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int res; 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(shift)) 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SHL16: inputs are not short: %d %d in %s: line %d\n", a, shift, file, line); 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a<<shift; 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SHL16: output is not short: %d in %s: line %d\n", res, file, line); 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 13298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int SHR32(long long a, int shift) 13398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 13498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 13598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(a) || !VERIFY_SHORT(shift)) 13698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 13798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SHR32: inputs are not int: %d %d\n", (int)a, shift); 13898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 13998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a>>shift; 14098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 14198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 14298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SHR32: output is not int: %d\n", (int)res); 14398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 14498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 14598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 14698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 14798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int SHL32(long long a, int shift) 14898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 14998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 15098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(a) || !VERIFY_SHORT(shift)) 15198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 15298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SHL32: inputs are not int: %d %d\n", (int)a, shift); 15398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 15498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a<<shift; 15598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 15698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 15798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SHL32: output is not int: %d\n", (int)res); 15898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 15998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 16098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 16198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 16298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PSHR16(a,shift) (SHR16(ADD16((a),((1<<((shift))>>1))),shift)) 16498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PSHR32(a,shift) (SHR32(ADD32((a),((EXTEND32(1)<<((shift))>>1))),shift)) 16598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define VSHR32(a, shift) (((shift)>0) ? SHR32(a, shift) : SHL32(a, -(shift))) 16698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SATURATE16(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x))) 16898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SATURATE32(x,a) (((x)>(a) ? (a) : (x)<-(a) ? -(a) : (x))) 16998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project//#define SHR(a,shift) ((a) >> (shift)) 17198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project//#define SHL(a,shift) ((a) << (shift)) 17298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define ADD16(a, b) _ADD16(a, b, __FILE__, __LINE__) 17498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short _ADD16(int a, int b, char *file, int line) 17598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 17698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int res; 17798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 17898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 17998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "ADD16: inputs are not short: %d %d in %s: line %d\n", a, b, file, line); 18098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 18198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a+b; 18298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 18398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 18498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "ADD16: output is not short: %d+%d=%d in %s: line %d\n", a,b,res, file, line); 18598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 18698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 18798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 18898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 18998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 19098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define SUB16(a, b) _SUB16(a, b, __FILE__, __LINE__) 19198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short _SUB16(int a, int b, char *file, int line) 19298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 19398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int res; 19498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 19598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 19698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SUB16: inputs are not short: %d %d in %s: line %d\n", a, b, file, line); 19798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 19898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a-b; 19998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 20098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SUB16: output is not short: %d in %s: line %d\n", res, file, line); 20198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 20298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 20398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 20498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 20598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define ADD32(a, b) _ADD32(a, b, __FILE__, __LINE__) 20698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int _ADD32(long long a, long long b, char *file, int line) 20798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 20898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 20998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(a) || !VERIFY_INT(b)) 21098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 21198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "ADD32: inputs are not int: %d %d in %s: line %d\n", (int)a, (int)b, file, line); 21298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 21398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a+b; 21498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 21598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 21698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "ADD32: output is not int: %d in %s: line %d\n", (int)res, file, line); 21798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 21898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 21998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 22098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 22198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 22298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int SUB32(long long a, long long b) 22398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 22498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 22598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(a) || !VERIFY_INT(b)) 22698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 22798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SUB32: inputs are not int: %d %d\n", (int)a, (int)b); 22898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 22998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a-b; 23098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 23198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "SUB32: output is not int: %d\n", (int)res); 23298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 23398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 23498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 23598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define ADD64(a,b) (MIPS_INC(a)+(b)) 23798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* result fits in 16 bits */ 23998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short MULT16_16_16(int a, int b) 24098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 24198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int res; 24298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 24398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 24498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_16: inputs are not short: %d %d\n", a, b); 24598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 24698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a*b; 24798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 24898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_16: output is not short: %d\n", res); 24998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 25098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 25198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 25298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 25398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_16(a, b) _MULT16_16(a, b, __FILE__, __LINE__) 25498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int _MULT16_16(int a, int b, char *file, int line) 25598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 25698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 25798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 25898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 25998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16: inputs are not short: %d %d in %s: line %d\n", a, b, file, line); 26098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 26198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((long long)a)*b; 26298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 26398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16: output is not int: %d in %s: line %d\n", (int)res, file, line); 26498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips++; 26598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 26698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 26798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 26898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_16(c,a,b) (spx_mips--,ADD32((c),MULT16_16((a),(b)))) 26998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_16_Q11(c,a,b) (EXTRACT16(ADD16((c),EXTRACT16(SHR32(MULT16_16((a),(b)),11))))) 27098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_16_Q13(c,a,b) (EXTRACT16(ADD16((c),EXTRACT16(SHR32(MULT16_16((a),(b)),13))))) 27198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_16_P13(c,a,b) (EXTRACT16(ADD32((c),SHR32(ADD32(4096,MULT16_16((a),(b))),13)))) 27298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 27398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 27498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_QX(a, b, Q) _MULT16_32_QX(a, b, Q, __FILE__, __LINE__) 27598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int _MULT16_32_QX(int a, long long b, int Q, char *file, int line) 27698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 27798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 27898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_INT(b)) 27998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 28098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_32_Q%d: inputs are not short+int: %d %d in %s: line %d\n", Q, (int)a, (int)b, file, line); 28198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 28298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (ABS32(b)>=(EXTEND32(1)<<(15+Q))) 28398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_32_Q%d: second operand too large: %d %d in %s: line %d\n", Q, (int)a, (int)b, file, line); 28498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = (((long long)a)*(long long)b) >> Q; 28598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 28698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_32_Q%d: output is not int: %d*%d=%d in %s: line %d\n", Q, (int)a, (int)b,(int)res, file, line); 28798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=5; 28898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 28998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 29098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 29198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int MULT16_32_PX(int a, long long b, int Q) 29298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 29398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 29498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_INT(b)) 29598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 29698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_32_P%d: inputs are not short+int: %d %d\n", Q, (int)a, (int)b); 29798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 29898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (ABS32(b)>=(EXTEND32(1)<<(15+Q))) 29998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_32_Q%d: second operand too large: %d %d\n", Q, (int)a, (int)b); 30098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((((long long)a)*(long long)b) + ((EXTEND32(1)<<Q)>>1))>> Q; 30198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 30298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_32_P%d: output is not int: %d*%d=%d\n", Q, (int)a, (int)b,(int)res); 30398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=5; 30498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 30598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 30698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q11(a,b) MULT16_32_QX(a,b,11) 30998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_32_Q11(c,a,b) ADD32((c),MULT16_32_Q11((a),(b))) 31098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q12(a,b) MULT16_32_QX(a,b,12) 31198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q13(a,b) MULT16_32_QX(a,b,13) 31298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q14(a,b) MULT16_32_QX(a,b,14) 31398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_Q15(a,b) MULT16_32_QX(a,b,15) 31498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MULT16_32_P15(a,b) MULT16_32_PX(a,b,15) 31598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAC16_32_Q15(c,a,b) ADD32((c),MULT16_32_Q15((a),(b))) 31698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 31798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int SATURATE(int a, int b) 31898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 31998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a>b) 32098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a=b; 32198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (a<-b) 32298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project a = -b; 32398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return a; 32498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 32598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 32698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int MULT16_16_Q11_32(int a, int b) 32798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 32898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 32998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 33098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 33198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_Q11: inputs are not short: %d %d\n", a, b); 33298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 33398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((long long)a)*b; 33498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res >>= 11; 33598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 33698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_Q11: output is not short: %d*%d=%d\n", (int)a, (int)b, (int)res); 33798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=3; 33898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 33998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 34098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short MULT16_16_Q13(int a, int b) 34198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 34298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 34398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 34498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 34598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_Q13: inputs are not short: %d %d\n", a, b); 34698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 34798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((long long)a)*b; 34898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res >>= 13; 34998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 35098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_Q13: output is not short: %d*%d=%d\n", a, b, (int)res); 35198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=3; 35298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 35398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 35498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short MULT16_16_Q14(int a, int b) 35598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 35698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 35798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 35898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 35998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_Q14: inputs are not short: %d %d\n", a, b); 36098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 36198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((long long)a)*b; 36298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res >>= 14; 36398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 36498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_Q14: output is not short: %d\n", (int)res); 36598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=3; 36698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 36798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 36898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short MULT16_16_Q15(int a, int b) 36998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 37098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 37198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 37298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 37398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_Q15: inputs are not short: %d %d\n", a, b); 37498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 37598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((long long)a)*b; 37698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res >>= 15; 37798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 37898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 37998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_Q15: output is not short: %d\n", (int)res); 38098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 38198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=3; 38298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 38398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 38498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 38598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short MULT16_16_P13(int a, int b) 38698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 38798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 38898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 38998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 39098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P13: inputs are not short: %d %d\n", a, b); 39198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 39298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((long long)a)*b; 39398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res += 4096; 39498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 39598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P13: overflow: %d*%d=%d\n", a, b, (int)res); 39698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res >>= 13; 39798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 39898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P13: output is not short: %d*%d=%d\n", a, b, (int)res); 39998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=4; 40098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 40198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 40298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short MULT16_16_P14(int a, int b) 40398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 40498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 40598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 40698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 40798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P14: inputs are not short: %d %d\n", a, b); 40898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 40998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((long long)a)*b; 41098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res += 8192; 41198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 41298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P14: overflow: %d*%d=%d\n", a, b, (int)res); 41398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res >>= 14; 41498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 41598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P14: output is not short: %d*%d=%d\n", a, b, (int)res); 41698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=4; 41798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 41898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 41998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline short MULT16_16_P15(int a, int b) 42098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 42198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 42298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(a) || !VERIFY_SHORT(b)) 42398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 42498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P15: inputs are not short: %d %d\n", a, b); 42598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 42698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = ((long long)a)*b; 42798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res += 16384; 42898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 42998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P15: overflow: %d*%d=%d\n", a, b, (int)res); 43098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res >>= 15; 43198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 43298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "MULT16_16_P15: output is not short: %d*%d=%d\n", a, b, (int)res); 43398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=4; 43498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 43598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 43698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 43798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define DIV32_16(a, b) _DIV32_16(a, b, __FILE__, __LINE__) 43898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 43998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int _DIV32_16(long long a, long long b, char *file, int line) 44098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 44198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 44298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (b==0) 44398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 44498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf(stderr, "DIV32_16: divide by zero: %d/%d in %s: line %d\n", (int)a, (int)b, file, line); 44598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 0; 44698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 44798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(a) || !VERIFY_SHORT(b)) 44898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 44998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "DIV32_16: inputs are not int/short: %d %d in %s: line %d\n", (int)a, (int)b, file, line); 45098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 45198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a/b; 45298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_SHORT(res)) 45398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 45498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "DIV32_16: output is not short: %d / %d = %d in %s: line %d\n", (int)a,(int)b,(int)res, file, line); 45598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (res>32767) 45698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = 32767; 45798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (res<-32768) 45898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = -32768; 45998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 46098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=20; 46198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 46298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 46398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 46498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define DIV32(a, b) _DIV32(a, b, __FILE__, __LINE__) 46598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline int _DIV32(long long a, long long b, char *file, int line) 46698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 46798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project long long res; 46898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (b==0) 46998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 47098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf(stderr, "DIV32: divide by zero: %d/%d in %s: line %d\n", (int)a, (int)b, file, line); 47198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return 0; 47298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 47398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 47498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(a) || !VERIFY_INT(b)) 47598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 47698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "DIV32: inputs are not int/short: %d %d in %s: line %d\n", (int)a, (int)b, file, line); 47798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 47898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project res = a/b; 47998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!VERIFY_INT(res)) 48098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fprintf (stderr, "DIV32: output is not int: %d in %s: line %d\n", (int)res, file, line); 48198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_mips+=36; 48298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return res; 48398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 48498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PDIV32(a,b) DIV32(ADD32((a),(b)>>1),b) 48598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define PDIV32_16(a,b) DIV32_16(ADD32((a),(b)>>1),b) 48698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 48798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 488