285 lines
6.8 KiB
C
285 lines
6.8 KiB
C
/*
|
|
* Copyright (c) 2011 The WebRTC project authors. All Rights Reserved.
|
|
*
|
|
* Use of this source code is governed by a BSD-style license
|
|
* that can be found in the LICENSE file in the root of the source
|
|
* tree. An additional intellectual property rights grant can be found
|
|
* in the file PATENTS. All contributing project authors may
|
|
* be found in the AUTHORS file in the root of the source tree.
|
|
*/
|
|
|
|
|
|
/*
|
|
* This header file includes the inline functions in the fix point signal processing library.
|
|
*/
|
|
|
|
#ifndef WEBRTC_SPL_SPL_INL_H_
|
|
#define WEBRTC_SPL_SPL_INL_H_
|
|
|
|
#ifdef WEBRTC_SPL_INLINE_CALLS
|
|
|
|
#ifdef ANDROID_ISACOPT
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WEBRTC_SPL_MUL(WebRtc_Word32 a, WebRtc_Word32 b)
|
|
{
|
|
WebRtc_Word32 tmp;
|
|
__asm__("mul %0, %1, %2":"=r"(tmp):"r"(a), "r"(b));
|
|
return tmp;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WEBRTC_SPL_MUL_16_32_RSFT16(WebRtc_Word16 a, WebRtc_Word32 b)
|
|
{
|
|
WebRtc_Word32 tmp;
|
|
__asm__("smulwb %0, %1, %2":"=r"(tmp):"r"(b), "r"(a));
|
|
return tmp;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WEBRTC_SPL_MUL_32_32_RSFT32(WebRtc_Word16 a,
|
|
WebRtc_Word16 b,
|
|
WebRtc_Word32 c)
|
|
{
|
|
WebRtc_Word32 tmp;
|
|
__asm__("pkhbt %0, %1, %2, lsl #16" : "=r"(tmp) : "r"(b), "r"(a));
|
|
__asm__("smmul %0, %1, %2":"=r"(tmp):"r"(tmp), "r"(c));
|
|
return tmp;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WEBRTC_SPL_MUL_32_32_RSFT32BI(
|
|
WebRtc_Word32 a,
|
|
WebRtc_Word32 b)
|
|
{
|
|
WebRtc_Word32 tmp;
|
|
__asm__("smmul %0, %1, %2":"=r"(tmp):"r"(a), "r"(b));
|
|
return tmp;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WEBRTC_SPL_MUL_16_16(WebRtc_Word16 a,WebRtc_Word16 b)
|
|
{
|
|
WebRtc_Word32 tmp;
|
|
__asm__("smulbb %0, %1, %2":"=r"(tmp):"r"(a), "r"(b));
|
|
return tmp;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word16 WebRtcSpl_AddSatW16(WebRtc_Word16 a, WebRtc_Word16 b)
|
|
{
|
|
WebRtc_Word32 s_sum;
|
|
|
|
__asm__("qadd16 %0, %1, %2":"=r"(s_sum):"r"(a), "r"(b));
|
|
|
|
return (WebRtc_Word16) s_sum;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WebRtcSpl_AddSatW32(WebRtc_Word32 l_var1, WebRtc_Word32 l_var2)
|
|
{
|
|
WebRtc_Word32 l_sum;
|
|
|
|
__asm__("qadd %0, %1, %2":"=r"(l_sum):"r"(l_var1), "r"(l_var2));
|
|
|
|
return l_sum;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word16 WebRtcSpl_SubSatW32(WebRtc_Word16 var1, WebRtc_Word16 var2)
|
|
{
|
|
WebRtc_Word32 s_sub;
|
|
|
|
__asm__("qsub16 %0, %1, %2":"=r"(s_sub):"r"(var1), "r"(var2));
|
|
|
|
return (WebRtc_Word16)s_sub;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WebRtcSpl_SubSatW32(WebRtc_Word32 l_var1, WebRtc_Word32 l_var2)
|
|
{
|
|
WebRtc_Word32 l_sub;
|
|
|
|
__asm__("qsub %0, %1, %2":"=r"(l_sub):"r"(l_var1), "r"(l_var2));
|
|
|
|
return l_sub;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word16 WebRtcSpl_GetSizeInBits(WebRtc_UWord32 n)
|
|
{
|
|
WebRtc_Word32 tmp;
|
|
|
|
__asm__("clz %0, %1":"=r"(tmp):"r"(n));
|
|
|
|
return (WebRtc_Word16)(32 - tmp);
|
|
}
|
|
|
|
WEBRTC_INLINE int WebRtcSpl_NormW32(WebRtc_Word32 a)
|
|
{
|
|
WebRtc_Word32 tmp;
|
|
|
|
if (a <= 0) a ^= 0xFFFFFFFF;
|
|
|
|
__asm__("clz %0, %1":"=r"(tmp):"r"(a));
|
|
|
|
return tmp - 1;
|
|
}
|
|
|
|
WEBRTC_INLINE int WebRtcSpl_NormW16(WebRtc_Word16 a)
|
|
{
|
|
int zeros;
|
|
|
|
if (a <= 0) a ^= 0xFFFF;
|
|
|
|
if (!(0xFF80 & a)) zeros = 8; else zeros = 0;
|
|
if (!(0xF800 & (a << zeros))) zeros += 4;
|
|
if (!(0xE000 & (a << zeros))) zeros += 2;
|
|
if (!(0xC000 & (a << zeros))) zeros += 1;
|
|
|
|
return zeros;
|
|
}
|
|
|
|
WEBRTC_INLINE int WebRtcSpl_NormU32(WebRtc_UWord32 a)
|
|
{
|
|
int tmp;
|
|
|
|
if (a == 0) return 0;
|
|
|
|
__asm__("clz %0, %1":"=r"(tmp):"r"(a));
|
|
|
|
return tmp;
|
|
}
|
|
|
|
#else
|
|
|
|
WEBRTC_INLINE WebRtc_Word16 WebRtcSpl_AddSatW16(WebRtc_Word16 a, WebRtc_Word16 b)
|
|
{
|
|
WebRtc_Word32 s_sum = (WebRtc_Word32) a + (WebRtc_Word32) b;
|
|
|
|
if (s_sum > WEBRTC_SPL_WORD16_MAX)
|
|
s_sum = WEBRTC_SPL_WORD16_MAX;
|
|
else if (s_sum < WEBRTC_SPL_WORD16_MIN)
|
|
s_sum = WEBRTC_SPL_WORD16_MIN;
|
|
|
|
return (WebRtc_Word16)s_sum;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WebRtcSpl_AddSatW32(WebRtc_Word32 l_var1, WebRtc_Word32 l_var2)
|
|
{
|
|
WebRtc_Word32 l_sum;
|
|
|
|
// perform long addition
|
|
l_sum = l_var1 + l_var2;
|
|
|
|
// check for under or overflow
|
|
if (WEBRTC_SPL_IS_NEG (l_var1))
|
|
{
|
|
if (WEBRTC_SPL_IS_NEG (l_var2) && !WEBRTC_SPL_IS_NEG (l_sum))
|
|
{
|
|
l_sum = (WebRtc_Word32)0x80000000;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if (!WEBRTC_SPL_IS_NEG (l_var2) && WEBRTC_SPL_IS_NEG (l_sum))
|
|
{
|
|
l_sum = (WebRtc_Word32)0x7FFFFFFF;
|
|
}
|
|
}
|
|
|
|
return l_sum;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word16 WebRtcSpl_SubSatW16( WebRtc_Word16 var1, WebRtc_Word16 var2)
|
|
{
|
|
WebRtc_Word32 l_diff;
|
|
WebRtc_Word16 s_diff;
|
|
|
|
// perform subtraction
|
|
l_diff = (WebRtc_Word32)var1 - (WebRtc_Word32)var2;
|
|
|
|
// default setting
|
|
s_diff = (WebRtc_Word16) l_diff;
|
|
|
|
// check for overflow
|
|
if (l_diff > (WebRtc_Word32)32767)
|
|
s_diff = (WebRtc_Word16)32767;
|
|
|
|
// check for underflow
|
|
if (l_diff < (WebRtc_Word32)-32768)
|
|
s_diff = (WebRtc_Word16)-32768;
|
|
|
|
return s_diff;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word32 WebRtcSpl_SubSatW32(WebRtc_Word32 l_var1, WebRtc_Word32 l_var2)
|
|
{
|
|
WebRtc_Word32 l_diff;
|
|
|
|
// perform subtraction
|
|
l_diff = l_var1 - l_var2;
|
|
|
|
// check for underflow
|
|
if ((l_var1 < 0) && (l_var2 > 0) && (l_diff > 0))
|
|
l_diff = (WebRtc_Word32)0x80000000;
|
|
// check for overflow
|
|
if ((l_var1 > 0) && (l_var2 < 0) && (l_diff < 0))
|
|
l_diff = (WebRtc_Word32)0x7FFFFFFF;
|
|
|
|
return l_diff;
|
|
}
|
|
|
|
WEBRTC_INLINE WebRtc_Word16 WebRtcSpl_GetSizeInBits(WebRtc_UWord32 n)
|
|
{
|
|
|
|
int bits;
|
|
|
|
if ((0xFFFF0000 & n)) bits = 16; else bits = 0;
|
|
if ((0x0000FF00 & (n >> bits))) bits += 8;
|
|
if ((0x000000F0 & (n >> bits))) bits += 4;
|
|
if ((0x0000000C & (n >> bits))) bits += 2;
|
|
if ((0x00000002 & (n >> bits))) bits += 1;
|
|
if ((0x00000001 & (n >> bits))) bits += 1;
|
|
|
|
return bits;
|
|
}
|
|
|
|
WEBRTC_INLINE int WebRtcSpl_NormW32(WebRtc_Word32 a)
|
|
{
|
|
int zeros;
|
|
|
|
if (a <= 0) a ^= 0xFFFFFFFF;
|
|
|
|
if (!(0xFFFF8000 & a)) zeros = 16; else zeros = 0;
|
|
if (!(0xFF800000 & (a << zeros))) zeros += 8;
|
|
if (!(0xF8000000 & (a << zeros))) zeros += 4;
|
|
if (!(0xE0000000 & (a << zeros))) zeros += 2;
|
|
if (!(0xC0000000 & (a << zeros))) zeros += 1;
|
|
|
|
return zeros;
|
|
}
|
|
|
|
WEBRTC_INLINE int WebRtcSpl_NormW16(WebRtc_Word16 a)
|
|
{
|
|
int zeros;
|
|
|
|
if (a <= 0) a ^= 0xFFFF;
|
|
|
|
if (!(0xFF80 & a)) zeros = 8; else zeros = 0;
|
|
if (!(0xF800 & (a << zeros))) zeros += 4;
|
|
if (!(0xE000 & (a << zeros))) zeros += 2;
|
|
if (!(0xC000 & (a << zeros))) zeros += 1;
|
|
|
|
return zeros;
|
|
}
|
|
|
|
WEBRTC_INLINE int WebRtcSpl_NormU32(WebRtc_UWord32 a)
|
|
{
|
|
int zeros;
|
|
|
|
if (a == 0) return 0;
|
|
|
|
if (!(0xFFFF0000 & a)) zeros = 16; else zeros = 0;
|
|
if (!(0xFF000000 & (a << zeros))) zeros += 8;
|
|
if (!(0xF0000000 & (a << zeros))) zeros += 4;
|
|
if (!(0xC0000000 & (a << zeros))) zeros += 2;
|
|
if (!(0x80000000 & (a << zeros))) zeros += 1;
|
|
|
|
return zeros;
|
|
}
|
|
|
|
#endif // ANDROID_ISACOPT
|
|
#endif // WEBRTC_SPL_INLINE_CALLS
|
|
#endif // WEBRTC_SPL_SPL_INL_H_
|