Shift_Sat_v32xv32.c revision 2c8e5cab3faa6d360e222b7a6c40a80083d021ac
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/* */ 202c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* Project:: */ 212c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* $Author: beq07716 $*/ 222c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* $Revision: 1000 $*/ 232c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* $Date: 2010-06-28 13:08:20 +0200 (Mon, 28 Jun 2010) $*/ 242c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 252c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/************************************************************************/ 262c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 272c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/********************************************************************************** 282c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent INCLUDE FILES 292c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent***********************************************************************************/ 302c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 312c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "VectorArithmetic.h" 322c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 332c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/********************************************************************************** 342c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent FUNCTION Shift_Sat_v32xv32 352c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent***********************************************************************************/ 362c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 372c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurentvoid Shift_Sat_v32xv32 (const LVM_INT16 val, 382c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent const LVM_INT32 *src, 392c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 *dst, 402c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT16 n) 412c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent{ 422c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 ii; 432c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT16 RShift; 442c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 452c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(val>0) 462c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 472c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 a,b; 482c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 492c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent for (ii = n; ii != 0; ii--) 502c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 512c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent a=*src; 522c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent src++; 532c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 542c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent b=(a<<val); 552c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 562c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if( (b>>val) != a ) /* if overflow occured, right shift will show difference*/ 572c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 582c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(a<0) 592c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 602c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent b=0x80000000l; 612c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 622c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else 632c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 642c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent b=0x7FFFFFFFl; 652c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 662c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 672c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 682c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent *dst = b; 692c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent dst++; 702c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 712c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 722c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else if(val<0) 732c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 742c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent RShift=(LVM_INT16)(-val); 752c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent for (ii = n; ii != 0; ii--) 762c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 772c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent *dst = (*src >> RShift); 782c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent dst++; 792c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent src++; 802c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 812c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 822c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else 832c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 842c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(src!=dst) 852c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 862c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent Copy_16((LVM_INT16 *)src,(LVM_INT16 *)dst,(LVM_INT16)(n<<1)); 872c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 882c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 892c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent return; 902c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent} 912c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 922c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/**********************************************************************************/ 93