1e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/* 2e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** Copyright 2003-2010, VisualOn, Inc. 3e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** 4e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** Licensed under the Apache License, Version 2.0 (the "License"); 5e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** you may not use this file except in compliance with the License. 6e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** You may obtain a copy of the License at 7e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** 8e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** http://www.apache.org/licenses/LICENSE-2.0 9e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** 10e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** Unless required by applicable law or agreed to in writing, software 11e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** distributed under the License is distributed on an "AS IS" BASIS, 12e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** See the License for the specific language governing permissions and 14e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** limitations under the License. 15e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard */ 16e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 17e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/***************************************************************************** 18e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * This file contains operations in double precision. * 19e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * These operations are not standard double precision operations. * 20e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * They are used where single precision is not enough but the full 32 bits * 21e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * precision is not necessary. For example, the function Div_32() has a * 22e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 24 bits precision which is enough for our purposes. * 23e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 24e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * The double precision numbers use a special representation: * 25e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 26e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_32 = hi<<16 + lo<<1 * 27e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 28e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_32 is a 32 bit integer. * 29e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * hi and lo are 16 bit signed integers. * 30e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * As the low part also contains the sign, this allows fast multiplication. * 31e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 32e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 0x8000 0000 <= L_32 <= 0x7fff fffe. * 33e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 34e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * We will use DPF (Double Precision Format )in this file to specify * 35e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * this special format. * 36e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ***************************************************************************** 37e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard*/ 38e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "typedef.h" 39e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "basic_op.h" 40e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "oper_32b.h" 41e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 42e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/***************************************************************************** 43e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 44e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Function L_Extract() * 45e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 46e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Extract from a 32 bit integer two 16 bit DPF. * 47e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 48e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Arguments: * 49e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 50e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_32 : 32 bit integer. * 51e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 0x8000 0000 <= L_32 <= 0x7fff ffff. * 52e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * hi : b16 to b31 of L_32 * 53e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * lo : (L_32 - hi<<16)>>1 * 54e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ***************************************************************************** 55e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard*/ 56e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 57e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard__inline void VO_L_Extract (Word32 L_32, Word16 *hi, Word16 *lo) 58e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 59e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *hi = (Word16)(L_32 >> 16); 60e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *lo = (Word16)((L_32 & 0xffff) >> 1); 61e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return; 62e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 63e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 64e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/***************************************************************************** 65e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 66e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Function L_Comp() * 67e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 68e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Compose from two 16 bit DPF a 32 bit integer. * 69e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 70e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_32 = hi<<16 + lo<<1 * 71e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 72e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Arguments: * 73e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 74e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * hi msb * 75e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * lo lsf (with sign) * 76e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 77e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Return Value : * 78e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 79e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 32 bit long signed integer (Word32) whose value falls in the * 80e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * range : 0x8000 0000 <= L_32 <= 0x7fff fff0. * 81e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 82e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ***************************************************************************** 83e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard*/ 84e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 85e2e838afcf03e603a41a0455846eaf9614537c16Mans RullgardWord32 L_Comp (Word16 hi, Word16 lo) 86e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 87e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word32 L_32; 88e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 89e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 = L_deposit_h (hi); 90e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 91e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return (L_mac (L_32, lo, 1)); /* = hi<<16 + lo<<1 */ 92e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 93e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 94e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/***************************************************************************** 95e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Function Mpy_32() * 96e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 97e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Multiply two 32 bit integers (DPF). The result is divided by 2**31 * 98e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 99e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_32 = (hi1*hi2)<<1 + ( (hi1*lo2)>>15 + (lo1*hi2)>>15 )<<1 * 100e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 101e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * This operation can also be viewed as the multiplication of two Q31 * 102e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * number and the result is also in Q31. * 103e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 104e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Arguments: * 105e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 106e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * hi1 hi part of first number * 107e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * lo1 lo part of first number * 108e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * hi2 hi part of second number * 109e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * lo2 lo part of second number * 110e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 111e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ***************************************************************************** 112e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard*/ 113e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 114e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard__inline Word32 Mpy_32 (Word16 hi1, Word16 lo1, Word16 hi2, Word16 lo2) 115e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 116e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word32 L_32; 117e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 = (hi1 * hi2); 118e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 += (hi1 * lo2) >> 15; 119e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 += (lo1 * hi2) >> 15; 120e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 <<= 1; 121e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 122e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return (L_32); 123e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 124e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 125e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/***************************************************************************** 126e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Function Mpy_32_16() * 127e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 128e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Multiply a 16 bit integer by a 32 bit (DPF). The result is divided * 129e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * by 2**15 * 130e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 131e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 132e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_32 = (hi1*lo2)<<1 + ((lo1*lo2)>>15)<<1 * 133e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 134e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Arguments: * 135e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 136e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * hi hi part of 32 bit number. * 137e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * lo lo part of 32 bit number. * 138e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * n 16 bit number. * 139e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 140e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ***************************************************************************** 141e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard*/ 142e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 143e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard__inline Word32 Mpy_32_16 (Word16 hi, Word16 lo, Word16 n) 144e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 145e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word32 L_32; 146e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 147e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 = (hi * n)<<1; 148e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 += (((lo * n)>>15)<<1); 149e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 150e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return (L_32); 151e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 152e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 153e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/***************************************************************************** 154e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 155e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Function Name : Div_32 * 156e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 157e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Purpose : * 158e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Fractional integer division of two 32 bit numbers. * 159e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_num / L_denom. * 160e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_num and L_denom must be positive and L_num < L_denom. * 161e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_denom = denom_hi<<16 + denom_lo<<1 * 162e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * denom_hi is a normalize number. * 163e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 164e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Inputs : * 165e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 166e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_num * 167e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 32 bit long signed integer (Word32) whose value falls in the * 168e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * range : 0x0000 0000 < L_num < L_denom * 169e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 170e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_denom = denom_hi<<16 + denom_lo<<1 (DPF) * 171e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 172e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * denom_hi * 173e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 16 bit positive normalized integer whose value falls in the * 174e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * range : 0x4000 < hi < 0x7fff * 175e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * denom_lo * 176e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 16 bit positive integer whose value falls in the * 177e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * range : 0 < lo < 0x7fff * 178e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 179e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Return Value : * 180e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 181e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * L_div * 182e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 32 bit long signed integer (Word32) whose value falls in the * 183e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * range : 0x0000 0000 <= L_div <= 0x7fff ffff. * 184e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 185e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * Algorithm: * 186e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 187e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * - find = 1/L_denom. * 188e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * First approximation: approx = 1 / denom_hi * 189e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * 1/L_denom = approx * (2.0 - L_denom * approx ) * 190e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * * 191e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard * - result = L_num * (1/L_denom) * 192e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ***************************************************************************** 193e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard*/ 194e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 195e2e838afcf03e603a41a0455846eaf9614537c16Mans RullgardWord32 Div_32 (Word32 L_num, Word16 denom_hi, Word16 denom_lo) 196e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 197e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 approx, hi, lo, n_hi, n_lo; 198e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word32 L_32; 199e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 200e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* First approximation: 1 / L_denom = 1/denom_hi */ 201e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 202e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard approx = div_s ((Word16) 0x3fff, denom_hi); 203e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 204e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* 1/L_denom = approx * (2.0 - L_denom * approx) */ 205e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 206e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 = Mpy_32_16 (denom_hi, denom_lo, approx); 207e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 208e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 = L_sub ((Word32) 0x7fffffffL, L_32); 209e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard hi = L_32 >> 16; 210e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard lo = (L_32 & 0xffff) >> 1; 211e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 212e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 = Mpy_32_16 (hi, lo, approx); 213e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 214e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* L_num * (1/L_denom) */ 215e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard hi = L_32 >> 16; 216e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard lo = (L_32 & 0xffff) >> 1; 217e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard VO_L_Extract (L_num, &n_hi, &n_lo); 218e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 = Mpy_32 (n_hi, n_lo, hi, lo); 219e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_32 = L_shl2(L_32, 2); 220e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 221e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return (L_32); 222e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 223e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 224