12c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* 22c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * Copyright (C) 2004-2010 NXP Software 32c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * Copyright (C) 2010 The Android Open Source Project 42c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * 52c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * Licensed under the Apache License, Version 2.0 (the "License"); 62c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * you may not use this file except in compliance with the License. 72c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * You may obtain a copy of the License at 82c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * 92c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * http://www.apache.org/licenses/LICENSE-2.0 102c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * 112c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * Unless required by applicable law or agreed to in writing, software 122c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * distributed under the License is distributed on an "AS IS" BASIS, 132c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 142c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * See the License for the specific language governing permissions and 152c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * limitations under the License. 162c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent */ 172c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 182c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/********************************************************************************** 192c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent INCLUDE FILES 202c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent***********************************************************************************/ 212c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 222c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "VectorArithmetic.h" 232c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 242c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/********************************************************************************** 252c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent FUNCTION Shift_Sat_v32xv32 262c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent***********************************************************************************/ 27d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri#ifdef BUILD_FLOAT 28d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katurivoid Shift_Sat_Float (const LVM_INT16 val, 29d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri const LVM_FLOAT *src, 30d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri LVM_FLOAT *dst, 31d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri LVM_INT16 n) 32d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri{ 33d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri LVM_FLOAT temp; 34d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri LVM_INT32 ii,ij; 35d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri LVM_INT16 RShift; 36d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri 37d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri if(val > 0) 38d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri { 39d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri for (ii = n; ii != 0; ii--) 40d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri { 41d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri temp = (LVM_FLOAT)*src; 42d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri src++; 43d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri for(ij = 0; ij < val; ij++) 44d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri { 45d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri temp = temp * 2; 46d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri } 47d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri 48d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri if(temp > 1.0) 49d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri temp = 1.0; 50d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri if(temp < -1.0) 51d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri temp = -1.0; 52d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri 53d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri *dst = (LVM_FLOAT)temp; 54d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri dst++; 55d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri } 56d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri } 57d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri else if(val < 0) 58d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri { 59d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri RShift=(LVM_INT16)(-val); 602c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 61d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri for (ii = n; ii != 0; ii--) 62d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri { 63d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri temp = (LVM_FLOAT)*src; 64d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri src++; 65d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri for(ij = 0; ij < RShift; ij++) 66d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri { 67d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri temp = temp / 2; 68d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri } 69d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri *dst = (LVM_FLOAT)temp; 70d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri dst++; 71d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri } 72d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri } 73d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri else 74d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri { 75d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri if(src != dst) 76d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri { 77d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri Copy_Float(src, dst, n); 78d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri } 79d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri } 80d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri return; 81d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri} 82d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri#else 832c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurentvoid Shift_Sat_v32xv32 (const LVM_INT16 val, 842c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent const LVM_INT32 *src, 852c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 *dst, 862c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT16 n) 872c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent{ 882c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 ii; 892c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT16 RShift; 902c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 912c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(val>0) 922c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 932c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 a,b; 942c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 952c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent for (ii = n; ii != 0; ii--) 962c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 972c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent a=*src; 982c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent src++; 992c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 1002c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent b=(a<<val); 1012c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 1022c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if( (b>>val) != a ) /* if overflow occured, right shift will show difference*/ 1032c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 1042c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(a<0) 1052c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 1062c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent b=0x80000000l; 1072c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1082c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else 1092c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 1102c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent b=0x7FFFFFFFl; 1112c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1122c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1132c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 1142c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent *dst = b; 1152c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent dst++; 1162c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1172c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1182c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else if(val<0) 1192c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 1202c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent RShift=(LVM_INT16)(-val); 1212c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent for (ii = n; ii != 0; ii--) 1222c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 1232c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent *dst = (*src >> RShift); 1242c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent dst++; 1252c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent src++; 1262c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1272c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1282c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else 1292c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 1302c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(src!=dst) 1312c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 1322c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent Copy_16((LVM_INT16 *)src,(LVM_INT16 *)dst,(LVM_INT16)(n<<1)); 1332c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1342c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 1352c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent return; 1362c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent} 137d7d013446a64c6de9f0f2dfe098a721b140e0b48Ramesh Katuri#endif 1382c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/**********************************************************************************/ 139