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 "LVM_Types.h" 232c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "LVM_Macros.h" 242c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "VectorArithmetic.h" 252c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 262c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/********************************************************************************** 272c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent FUNCTION DelayAllPass_32x32 282c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent***********************************************************************************/ 292c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 302c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurentvoid DelayAllPass_Sat_32x16To32( LVM_INT32 *delay, /* Delay buffer */ 312c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_UINT16 size, /* Delay size */ 322c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT16 coeff, /* All pass filter coefficient */ 332c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_UINT16 DelayOffset, /* Simple delay offset */ 342c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_UINT16 *pAllPassOffset, /* All pass filter delay offset */ 352c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 *dst, /* Source/destination */ 362c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT16 n) /* Number of samples */ 372c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent{ 382c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT16 i; 392c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_UINT16 AllPassOffset = *pAllPassOffset; 402c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 temp; 412c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 a,b,c; 422c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 432c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent for (i = 0; i < n; i++) 442c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 452c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 462c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent MUL32x16INTO32(delay[AllPassOffset], coeff, temp, 15) 472c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent a = temp; 482c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent b = delay[DelayOffset]; 492c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent DelayOffset++; 502c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 512c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent c = a + b; 522c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if ((((c ^ a) & (c ^ b)) >> 31) != 0) /* overflow / underflow */ 532c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 542c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(a < 0) 552c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 562c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent c = 0x80000000l; 572c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 582c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else 592c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 602c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent c = 0x7FFFFFFFl; 612c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 622c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 632c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent *dst = c; 642c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent dst++; 652c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 662c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 672c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent MUL32x16INTO32(c, -coeff, temp, 15) 682c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent a = temp; 692c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent b = delay[AllPassOffset]; 702c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent c = a + b; 712c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if ((((c ^ a) & (c ^ b)) >> 31)!=0) /* overflow / underflow */ 722c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 732c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(a < 0) 742c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 752c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent c = 0x80000000l; 762c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 772c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else 782c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 792c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent c = 0x7FFFFFFFl; 802c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 812c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 822c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent delay[AllPassOffset] = c; 832c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent AllPassOffset++; 842c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 852c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent /* Make the delay buffer a circular buffer */ 862c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if (DelayOffset >= size) 872c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 882c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent DelayOffset = 0; 892c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 902c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 912c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if (AllPassOffset >= size) 922c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 932c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent AllPassOffset = 0; 942c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 952c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 962c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 972c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent /* Update the offset */ 982c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent *pAllPassOffset = AllPassOffset; 992c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 1002c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent return; 1012c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent} 1022c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 1032c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/**********************************************************************************/ 1042c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 105