14f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* ------------------------------------------------------------------ 24f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Copyright (C) 1998-2009 PacketVideo 34f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 44f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License"); 54f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * you may not use this file except in compliance with the License. 64f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * You may obtain a copy of the License at 74f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 84f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * http://www.apache.org/licenses/LICENSE-2.0 94f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Unless required by applicable law or agreed to in writing, software 114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS, 124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either 134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * express or implied. 144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * See the License for the specific language governing permissions 154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * and limitations under the License. 164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * ------------------------------------------------------------------- 174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/**************************************************************************************** 194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas HuberPortions of this file are derived from the following 3GPP standard: 204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3GPP TS 26.173 224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ANSI-C code for the Adaptive Multi-Rate - Wideband (AMR-WB) speech codec 234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Available from http://www.3gpp.org 244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber(C) 2007, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC) 264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas HuberPermission to distribute, modify and use this file under the standard license 274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberterms listed above has been obtained from the copyright holder. 284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber****************************************************************************************/ 294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*___________________________________________________________________________ 304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber This file contains mathematic operations in fixed point. 324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mult_int16_r() : Same as mult_int16 with rounding 344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber shr_rnd() : Same as shr(var1,var2) but with rounding 354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber div_16by16() : fractional integer division 364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber one_ov_sqrt() : Compute 1/sqrt(L_x) 374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber one_ov_sqrt_norm() : Compute 1/sqrt(x) 384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber power_of_2() : power of 2 394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Dot_product12() : Compute scalar product of <x[],y[]> using accumulator 404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Isqrt() : inverse square root (16 bits precision). 414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber amrwb_log_2() : log2 (16 bits precision). 424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber These operations are not standard double precision operations. 444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber They are used where low complexity is important and the full 32 bits 454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber precision is not necessary. For example, the function Div_32() has a 464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 24 bits precision which is enough for our purposes. 474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber In this file, the values use theses representations: 494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_32 : standard signed 32 bits format 514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 hi, lo : L_32 = hi<<16 + lo<<1 (DPF - Double Precision Format) 524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 frac, int16 exp : L_32 = frac << exp-31 (normalised format) 534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 int, frac : L_32 = int.frac (fractional format) 544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pv_amr_wb_type_defs.h" 574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_basic_op.h" 584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwb_math_op.h" 594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Function Name : mult_int16_r 644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Purpose : 664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Same as mult_int16 with rounding, i.e.: 684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mult_int16_r(var1,var2) = extract_l(L_shr(((var1 * var2) + 16384),15)) and 694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mult_int16_r(-32768,-32768) = 32767. 704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Complexity weight : 2 724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Inputs : 744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var1 764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : 0xffff 8000 <= var1 <= 0x0000 7fff. 784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var2 804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : 0xffff 8000 <= var1 <= 0x0000 7fff. 824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Outputs : 844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber none 864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Return Value : 884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out 904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : 0xffff 8000 <= var_out <= 0x0000 7fff. 924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint16 mult_int16_r(int16 var1, int16 var2) 954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_product_arr; 974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_product_arr = (int32) var1 * (int32) var2; /* product */ 994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_product_arr += (int32) 0x00004000L; /* round */ 1004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_product_arr >>= 15; /* shift */ 1014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((L_product_arr >> 15) != (L_product_arr >> 31)) 1024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 1034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_product_arr = (L_product_arr >> 31) ^ MAX_16; 1044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 1054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return ((int16)L_product_arr); 1074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 1084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Function Name : shr_rnd 1144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Purpose : 1164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Same as shr(var1,var2) but with rounding. Saturate the result in case of| 1184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber underflows or overflows : 1194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber - If var2 is greater than zero : 1204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (sub(shl_int16(shr(var1,var2),1),shr(var1,sub(var2,1)))) 1214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber is equal to zero 1224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber then 1234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber shr_rnd(var1,var2) = shr(var1,var2) 1244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 1254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber shr_rnd(var1,var2) = add_int16(shr(var1,var2),1) 1264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber - If var2 is less than or equal to zero : 1274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber shr_rnd(var1,var2) = shr(var1,var2). 1284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Complexity weight : 2 1304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Inputs : 1324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var1 1344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 1354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : 0xffff 8000 <= var1 <= 0x0000 7fff. 1364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var2 1384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 1394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : 0x0000 0000 <= var2 <= 0x0000 7fff. 1404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Outputs : 1424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber none 1444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Return Value : 1464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out 1484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 1494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : 0xffff 8000 <= var_out <= 0x0000 7fff. 1504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 1514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint16 shr_rnd(int16 var1, int16 var2) 1534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 var_out; 1554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out = (int16)(var1 >> (var2 & 0xf)); 1574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (var2) 1584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 1594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((var1 & ((int16) 1 << (var2 - 1))) != 0) 1604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 1614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out++; 1624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 1634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 1644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return (var_out); 1654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 1664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Function Name : div_16by16 1714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Purpose : 1734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Produces a result which is the fractional integer division of var1 by 1754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var2; var1 and var2 must be positive and var2 must be greater or equal 1764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber to var1; the result is positive (leading bit equal to 0) and truncated 1774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber to 16 bits. 1784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber If var1 = var2 then div(var1,var2) = 32767. 1794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Complexity weight : 18 1814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Inputs : 1834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var1 1854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 1864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : 0x0000 0000 <= var1 <= var2 and var2 != 0. 1874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var2 1894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 1904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : var1 <= var2 <= 0x0000 7fff and var2 != 0. 1914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Outputs : 1934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber none 1954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Return Value : 1974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out 1994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16 bit short signed integer (int16) whose value falls in the 2004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber range : 0x0000 0000 <= var_out <= 0x0000 7fff. 2014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber It's a Q15 value (point between b15 and b14). 2024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 2034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint16 div_16by16(int16 var1, int16 var2) 2054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 2064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 var_out = 0; 2084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber register int16 iteration; 2094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_num; 2104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_denom; 2114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_denom_by_2; 2124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_denom_by_4; 2134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((var1 > var2) || (var1 < 0)) 2154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return 0; // used to exit(0); 2174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (var1) 2194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (var1 != var2) 2214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_num = (int32) var1; 2244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_denom = (int32) var2; 2254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_denom_by_2 = (L_denom << 1); 2264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_denom_by_4 = (L_denom << 2); 2274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (iteration = 5; iteration > 0; iteration--) 2284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out <<= 3; 2304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_num <<= 3; 2314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_num >= L_denom_by_4) 2334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_num -= L_denom_by_4; 2354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out |= 4; 2364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_num >= L_denom_by_2) 2394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_num -= L_denom_by_2; 2414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out |= 2; 2424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_num >= (L_denom)) 2454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_num -= (L_denom); 2474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out |= 1; 2484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 2534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber var_out = MAX_16; 2554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return (var_out); 2594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 2614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 2654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Function Name : one_ov_sqrt 2674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Compute 1/sqrt(L_x). 2694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if L_x is negative or zero, result is 1 (7fffffff). 2704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Algorithm: 2724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1- Normalization of L_x. 2744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2- call Isqrt_n(L_x, exponant) 2754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3- L_y = L_x << exponant 2764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 2774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint32 one_ov_sqrt( /* (o) Q31 : output value (range: 0<=val<1) */ 2784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_x /* (i) Q0 : input value (range: 0<=val<=7fffffff) */ 2794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 2804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 2814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 exp; 2824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_y; 2834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp = normalize_amr_wb(L_x); 2854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_x <<= exp; /* L_x is normalized */ 2864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp = 31 - exp; 2874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber one_ov_sqrt_norm(&L_x, &exp); 2894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_y = shl_int32(L_x, exp); /* denormalization */ 2914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return (L_y); 2934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 2944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 2964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Function Name : one_ov_sqrt_norm 2984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Compute 1/sqrt(value). 3004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if value is negative or zero, result is 1 (frac=7fffffff, exp=0). 3014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Algorithm: 3034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber The function 1/sqrt(value) is approximated by a table and linear 3054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber interpolation. 3064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1- If exponant is odd then shift fraction right once. 3084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2- exponant = -((exponant-1)>>1) 3094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3- i = bit25-b30 of fraction, 16 <= i <= 63 ->because of normalization. 3104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4- a = bit10-b24 3114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5- i -=16 3124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6- fraction = table[i]<<16 - (table[i] - table[i+1]) * a * 2 3134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 3144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberstatic const int16 table_isqrt[49] = 3154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 3164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 32767, 31790, 30894, 30070, 29309, 28602, 27945, 27330, 26755, 26214, 3174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 25705, 25225, 24770, 24339, 23930, 23541, 23170, 22817, 22479, 22155, 3184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 21845, 21548, 21263, 20988, 20724, 20470, 20225, 19988, 19760, 19539, 3194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 19326, 19119, 18919, 18725, 18536, 18354, 18176, 18004, 17837, 17674, 3204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 17515, 17361, 17211, 17064, 16921, 16782, 16646, 16514, 16384 3214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber}; 3224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid one_ov_sqrt_norm( 3244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 * frac, /* (i/o) Q31: normalized value (1.0 < frac <= 0.5) */ 3254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * exp /* (i/o) : exponent (value = frac x 2^exponent) */ 3264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 3274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 3284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, a, tmp; 3294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (*frac <= (int32) 0) 3324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *exp = 0; 3344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *frac = 0x7fffffffL; 3354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 3364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((*exp & 1) == 1) /* If exponant odd -> shift right */ 3394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *frac >>= 1; 3404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *exp = negate_int16((*exp - 1) >> 1); 3424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *frac >>= 9; 3444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber i = extract_h(*frac); /* Extract b25-b31 */ 3454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *frac >>= 1; 3464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber a = (int16)(*frac); /* Extract b10-b24 */ 3474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber a = (int16)(a & (int16) 0x7fff); 3484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber i -= 16; 3504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *frac = L_deposit_h(table_isqrt[i]); /* table[i] << 16 */ 3524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = table_isqrt[i] - table_isqrt[i + 1]; /* table[i] - table[i+1]) */ 3534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *frac = msu_16by16_from_int32(*frac, tmp, a); /* frac -= tmp*a*2 */ 3554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 3574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 3584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 3604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Function Name : power_2() 3624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_x = pow(2.0, exponant.fraction) (exponant = interger part) 3644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber = pow(2.0, 0.fraction) << exponant 3654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Algorithm: 3674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber The function power_2(L_x) is approximated by a table and linear 3694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber interpolation. 3704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1- i = bit10-b15 of fraction, 0 <= i <= 31 3724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2- a = bit0-b9 of fraction 3734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3- L_x = table[i]<<16 - (table[i] - table[i+1]) * a * 2 3744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4- L_x = L_x >> (30-exponant) (with rounding) 3754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 3764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberconst int16 table_pow2[33] = 3774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 3784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 16384, 16743, 17109, 17484, 17867, 18258, 18658, 19066, 19484, 19911, 3794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 20347, 20792, 21247, 21713, 22188, 22674, 23170, 23678, 24196, 24726, 3804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 25268, 25821, 26386, 26964, 27554, 28158, 28774, 29405, 30048, 30706, 3814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 31379, 32066, 32767 3824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber}; 3834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint32 power_of_2( /* (o) Q0 : result (range: 0<=val<=0x7fffffff) */ 3854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 exponant, /* (i) Q0 : Integer part. (range: 0<=val<=30) */ 3864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 fraction /* (i) Q15 : Fractionnal part. (range: 0.0<=val<1.0) */ 3874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 3884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 3894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 exp, i, a, tmp; 3904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_x; 3914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_x = fraction << 5; /* L_x = fraction<<6 */ 3934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber i = (fraction >> 10); /* Extract b10-b16 of fraction */ 3944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber a = (int16)(L_x); /* Extract b0-b9 of fraction */ 3954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber a = (int16)(a & (int16) 0x7fff); 3964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_x = ((int32)table_pow2[i]) << 15; /* table[i] << 16 */ 3984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = table_pow2[i] - table_pow2[i + 1]; /* table[i] - table[i+1] */ 3994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_x -= ((int32)tmp * a); /* L_x -= tmp*a*2 */ 4004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp = 29 - exponant ; 4024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (exp) 4044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_x = ((L_x >> exp) + ((L_x >> (exp - 1)) & 1)); 4064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return (L_x); 4094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 4104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 4124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Function Name : Dot_product12() 4144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Compute scalar product of <x[],y[]> using accumulator. 4164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * The result is normalized (in Q31) with exponent (0..30). 4184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Algorithm: 4204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * dot_product = sum(x[i]*y[i]) i=0..N-1 4224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 4234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint32 Dot_product12( /* (o) Q31: normalized result (1 < val <= -1) */ 4254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 x[], /* (i) 12bits: x vector */ 4264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 y[], /* (i) 12bits: y vector */ 4274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 lg, /* (i) : vector length */ 4284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * exp /* (o) : exponent of result (0..+30) */ 4294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 4304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 4314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, sft; 4324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_sum; 4334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *pt_x = x; 4344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *pt_y = y; 4354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = 1L; 4374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = lg >> 3; i != 0; i--) 4404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = mac_16by16_to_int32(L_sum, *(pt_x++), *(pt_y++)); 4424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = mac_16by16_to_int32(L_sum, *(pt_x++), *(pt_y++)); 4434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = mac_16by16_to_int32(L_sum, *(pt_x++), *(pt_y++)); 4444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = mac_16by16_to_int32(L_sum, *(pt_x++), *(pt_y++)); 4454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = mac_16by16_to_int32(L_sum, *(pt_x++), *(pt_y++)); 4464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = mac_16by16_to_int32(L_sum, *(pt_x++), *(pt_y++)); 4474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = mac_16by16_to_int32(L_sum, *(pt_x++), *(pt_y++)); 4484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum = mac_16by16_to_int32(L_sum, *(pt_x++), *(pt_y++)); 4494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Normalize acc in Q31 */ 4524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber sft = normalize_amr_wb(L_sum); 4544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_sum <<= sft; 4554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *exp = 30 - sft; /* exponent = 0..30 */ 4574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return (L_sum); 4594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 4604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* Table for Log2() */ 4624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberconst int16 Log2_norm_table[33] = 4634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 4644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 1455, 2866, 4236, 5568, 6863, 8124, 9352, 10549, 11716, 4654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 12855, 13967, 15054, 16117, 17156, 18172, 19167, 20142, 21097, 22033, 4664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 22951, 23852, 24735, 25603, 26455, 27291, 28113, 28922, 29716, 30497, 4674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 31266, 32023, 32767 4684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber}; 4694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 4714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * FUNCTION: Lg2_normalized() 4734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * PURPOSE: Computes log2(L_x, exp), where L_x is positive and 4754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * normalized, and exp is the normalisation exponent 4764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * If L_x is negative or zero, the result is 0. 4774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * DESCRIPTION: 4794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * The function Log2(L_x) is approximated by a table and linear 4804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * interpolation. The following steps are used to compute Log2(L_x) 4814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 1- exponent = 30-norm_exponent 4834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 2- i = bit25-b31 of L_x; 32<=i<=63 (because of normalization). 4844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 3- a = bit10-b24 4854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4- i -=32 4864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5- fraction = table[i]<<16 - (table[i] - table[i+1]) * a * 2 4874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 4884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 4894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid Lg2_normalized( 4904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_x, /* (i) : input value (normalized) */ 4914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 exp, /* (i) : norm_l (L_x) */ 4924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *exponent, /* (o) : Integer part of Log2. (range: 0<=val<=30) */ 4934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *fraction /* (o) : Fractional part of Log2. (range: 0<=val<1) */ 4944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 4954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 4964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, a, tmp; 4974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_y; 4984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_x <= (int32) 0) 5004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *exponent = 0; 5024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *fraction = 0;; 5034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 5044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *exponent = 30 - exp; 5074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_x >>= 9; 5094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber i = extract_h(L_x); /* Extract b25-b31 */ 5104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_x >>= 1; 5114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber a = (int16)(L_x); /* Extract b10-b24 of fraction */ 5124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber a &= 0x7fff; 5134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber i -= 32; 5154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_y = L_deposit_h(Log2_norm_table[i]); /* table[i] << 16 */ 5174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = Log2_norm_table[i] - Log2_norm_table[i + 1]; /* table[i] - table[i+1] */ 5184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_y = msu_16by16_from_int32(L_y, tmp, a); /* L_y -= tmp*a*2 */ 5194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *fraction = extract_h(L_y); 5214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 5234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 5244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 5284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * FUNCTION: amrwb_log_2() 5304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * PURPOSE: Computes log2(L_x), where L_x is positive. 5324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * If L_x is negative or zero, the result is 0. 5334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * DESCRIPTION: 5354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * normalizes L_x and then calls Lg2_normalized(). 5364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 5384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid amrwb_log_2( 5394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_x, /* (i) : input value */ 5404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *exponent, /* (o) : Integer part of Log2. (range: 0<=val<=30) */ 5414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *fraction /* (o) : Fractional part of Log2. (range: 0<=val<1) */ 5424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 5434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 5444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 exp; 5454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp = normalize_amr_wb(L_x); 5474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Lg2_normalized(shl_int32(L_x, exp), exp, exponent, fraction); 5484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 5494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/***************************************************************************** 5524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * These operations are not standard double precision operations. * 5544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * They are used where single precision is not enough but the full 32 bits * 5554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * precision is not necessary. For example, the function Div_32() has a * 5564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 24 bits precision which is enough for our purposes. * 5574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * * 5584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * The double precision numbers use a special representation: * 5594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * * 5604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * L_32 = hi<<16 + lo<<1 * 5614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * * 5624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * L_32 is a 32 bit integer. * 5634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * hi and lo are 16 bit signed integers. * 5644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * As the low part also contains the sign, this allows fast multiplication. * 5654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * * 5664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 0x8000 0000 <= L_32 <= 0x7fff fffe. * 5674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * * 5684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * We will use DPF (Double Precision Format )in this file to specify * 5694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * this special format. * 5704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ***************************************************************************** 5714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber*/ 5724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 5754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Function int32_to_dpf() 5774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Extract from a 32 bit integer two 16 bit DPF. 5794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Arguments: 5814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * L_32 : 32 bit integer. 5834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 0x8000 0000 <= L_32 <= 0x7fff ffff. 5844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * hi : b16 to b31 of L_32 5854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * lo : (L_32 - hi<<16)>>1 5864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 5884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid int32_to_dpf(int32 L_32, int16 *hi, int16 *lo) 5904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 5914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *hi = (int16)(L_32 >> 16); 5924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *lo = (int16)((L_32 - (*hi << 16)) >> 1); 5934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 5944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 5954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 5984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Function mpy_dpf_32() 5994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 6004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Multiply two 32 bit integers (DPF). The result is divided by 2**31 6014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 6024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * L_32 = (hi1*hi2)<<1 + ( (hi1*lo2)>>15 + (lo1*hi2)>>15 )<<1 6034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 6044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * This operation can also be viewed as the multiplication of two Q31 6054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * number and the result is also in Q31. 6064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 6074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Arguments: 6084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 6094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * hi1 hi part of first number 6104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * lo1 lo part of first number 6114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * hi2 hi part of second number 6124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * lo2 lo part of second number 6134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 6144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ----------------------------------------------------------------------------*/ 6154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint32 mpy_dpf_32(int16 hi1, int16 lo1, int16 hi2, int16 lo2) 6174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 6184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_32; 6194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_32 = mul_16by16_to_int32(hi1, hi2); 6214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_32 = mac_16by16_to_int32(L_32, mult_int16(hi1, lo2), 1); 6224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_32 = mac_16by16_to_int32(L_32, mult_int16(lo1, hi2), 1); 6234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return (L_32); 6254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 6264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 628