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#include "LVM_Types.h" 192c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "LVM_Macros.h" 202c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "ScalarArithmetic.h" 212c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 222c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/*-------------------------------------------------------------------------*/ 232c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* FUNCTION: */ 242c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_Polynomial */ 252c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 262c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* DESCRIPTION: */ 272c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* This function performs polynomial expansion */ 282c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* Y = (A0 + A1*X + A2*X2 + A3*X3 + �.. + AN*xN) << AN+1 */ 292c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 302c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_INT32 LVM_Polynomial(LVM_UINT16 N, */ 312c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_INT32 *pCoefficients, */ 322c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_INT32 X) */ 332c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 342c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* PARAMETERS: */ 352c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 362c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* N is the polynomial order */ 372c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* pCoefficients is the ptr to polynomial coefficients A0,A1.. in Q.31 */ 382c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* X is the input variable */ 392c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 402c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* RETURNS: */ 412c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* The result of the polynomial expansion in Q1.31 format */ 422c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/*-------------------------------------------------------------------------*/ 432c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 442c8e5cab3faa6d360e222b7a6c40a80083d021acEric LaurentLVM_INT32 LVM_Polynomial(LVM_UINT16 N, 452c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 *pCoefficients, 462c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 X) 472c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent{ 482c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 i; 492c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 Y,A,XTemp,Temp,sign; 502c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 512c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent Y=*pCoefficients; /* Y=A0*/ 522c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent pCoefficients++; 532c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 542c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if((LVM_UINT32)X==0x80000000) 552c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 562c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent Temp=-1; 572c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent sign=Temp; 582c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent for(i=1;i<=N;i++) 592c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 602c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent Y+=((*pCoefficients)*sign); 612c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent pCoefficients++; 622c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent sign*=Temp; 632c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 642c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 652c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 662c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 672c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else 682c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 692c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent XTemp=X; 702c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent for(i=N-1;i>=0;i--) 712c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 722c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent A=*pCoefficients; 732c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent pCoefficients++; 742c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 752c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent MUL32x32INTO32(A,XTemp,Temp,31) 762c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent Y+=Temp; 772c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 782c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent MUL32x32INTO32(XTemp,X,Temp,31) 792c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent XTemp=Temp; 802c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 812c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 822c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent A=*pCoefficients; 832c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent pCoefficients++; 842c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 852c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent if(A<0) 862c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 872c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent A=Abs_32(A); 882c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent Y=Y>>A; 892c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 902c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent else 912c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent { 922c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent Y = Y<<A; 932c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent } 942c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent return Y; 952c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent} 962c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 97