michael@0: /***********************************************************************
michael@0: Copyright (c) 2006-2011, Skype Limited. All rights reserved.
michael@0: Copyright (c) 2013       Parrot
michael@0: Redistribution and use in source and binary forms, with or without
michael@0: modification, are permitted provided that the following conditions
michael@0: are met:
michael@0: - Redistributions of source code must retain the above copyright notice,
michael@0: this list of conditions and the following disclaimer.
michael@0: - Redistributions in binary form must reproduce the above copyright
michael@0: notice, this list of conditions and the following disclaimer in the
michael@0: documentation and/or other materials provided with the distribution.
michael@0: - Neither the name of Internet Society, IETF or IETF Trust, nor the
michael@0: names of specific contributors, may be used to endorse or promote
michael@0: products derived from this software without specific prior written
michael@0: permission.
michael@0: THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
michael@0: AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
michael@0: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
michael@0: ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
michael@0: LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
michael@0: CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
michael@0: SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
michael@0: INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
michael@0: CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
michael@0: ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
michael@0: POSSIBILITY OF SUCH DAMAGE.
michael@0: ***********************************************************************/
michael@0: 
michael@0: #ifndef SILK_MACROS_ARMv5E_H
michael@0: #define SILK_MACROS_ARMv5E_H
michael@0: 
michael@0: /* (a32 * (opus_int32)((opus_int16)(b32))) >> 16 output have to be 32bit int */
michael@0: #undef silk_SMULWB
michael@0: static OPUS_INLINE opus_int32 silk_SMULWB_armv5e(opus_int32 a, opus_int16 b)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SMULWB\n\t"
michael@0:       "smulwb %0, %1, %2\n\t"
michael@0:       : "=r"(res)
michael@0:       : "r"(a), "r"(b)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SMULWB(a, b) (silk_SMULWB_armv5e(a, b))
michael@0: 
michael@0: /* a32 + (b32 * (opus_int32)((opus_int16)(c32))) >> 16 output have to be 32bit int */
michael@0: #undef silk_SMLAWB
michael@0: static OPUS_INLINE opus_int32 silk_SMLAWB_armv5e(opus_int32 a, opus_int32 b,
michael@0:  opus_int16 c)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SMLAWB\n\t"
michael@0:       "smlawb %0, %1, %2, %3\n\t"
michael@0:       : "=r"(res)
michael@0:       : "r"(b), "r"(c), "r"(a)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SMLAWB(a, b, c) (silk_SMLAWB_armv5e(a, b, c))
michael@0: 
michael@0: /* (a32 * (b32 >> 16)) >> 16 */
michael@0: #undef silk_SMULWT
michael@0: static OPUS_INLINE opus_int32 silk_SMULWT_armv5e(opus_int32 a, opus_int32 b)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SMULWT\n\t"
michael@0:       "smulwt %0, %1, %2\n\t"
michael@0:       : "=r"(res)
michael@0:       : "r"(a), "r"(b)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SMULWT(a, b) (silk_SMULWT_armv5e(a, b))
michael@0: 
michael@0: /* a32 + (b32 * (c32 >> 16)) >> 16 */
michael@0: #undef silk_SMLAWT
michael@0: static OPUS_INLINE opus_int32 silk_SMLAWT_armv5e(opus_int32 a, opus_int32 b,
michael@0:  opus_int32 c)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SMLAWT\n\t"
michael@0:       "smlawt %0, %1, %2, %3\n\t"
michael@0:       : "=r"(res)
michael@0:       : "r"(b), "r"(c), "r"(a)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SMLAWT(a, b, c) (silk_SMLAWT_armv5e(a, b, c))
michael@0: 
michael@0: /* (opus_int32)((opus_int16)(a3))) * (opus_int32)((opus_int16)(b32)) output have to be 32bit int */
michael@0: #undef silk_SMULBB
michael@0: static OPUS_INLINE opus_int32 silk_SMULBB_armv5e(opus_int32 a, opus_int32 b)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SMULBB\n\t"
michael@0:       "smulbb %0, %1, %2\n\t"
michael@0:       : "=r"(res)
michael@0:       : "%r"(a), "r"(b)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SMULBB(a, b) (silk_SMULBB_armv5e(a, b))
michael@0: 
michael@0: /* a32 + (opus_int32)((opus_int16)(b32)) * (opus_int32)((opus_int16)(c32)) output have to be 32bit int */
michael@0: #undef silk_SMLABB
michael@0: static OPUS_INLINE opus_int32 silk_SMLABB_armv5e(opus_int32 a, opus_int32 b,
michael@0:  opus_int32 c)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SMLABB\n\t"
michael@0:       "smlabb %0, %1, %2, %3\n\t"
michael@0:       : "=r"(res)
michael@0:       : "%r"(b), "r"(c), "r"(a)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SMLABB(a, b, c) (silk_SMLABB_armv5e(a, b, c))
michael@0: 
michael@0: /* (opus_int32)((opus_int16)(a32)) * (b32 >> 16) */
michael@0: #undef silk_SMULBT
michael@0: static OPUS_INLINE opus_int32 silk_SMULBT_armv5e(opus_int32 a, opus_int32 b)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SMULBT\n\t"
michael@0:       "smulbt %0, %1, %2\n\t"
michael@0:       : "=r"(res)
michael@0:       : "r"(a), "r"(b)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SMULBT(a, b) (silk_SMULBT_armv5e(a, b))
michael@0: 
michael@0: /* a32 + (opus_int32)((opus_int16)(b32)) * (c32 >> 16) */
michael@0: #undef silk_SMLABT
michael@0: static OPUS_INLINE opus_int32 silk_SMLABT_armv5e(opus_int32 a, opus_int32 b,
michael@0:  opus_int32 c)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SMLABT\n\t"
michael@0:       "smlabt %0, %1, %2, %3\n\t"
michael@0:       : "=r"(res)
michael@0:       : "r"(b), "r"(c), "r"(a)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SMLABT(a, b, c) (silk_SMLABT_armv5e(a, b, c))
michael@0: 
michael@0: /* add/subtract with output saturated */
michael@0: #undef silk_ADD_SAT32
michael@0: static OPUS_INLINE opus_int32 silk_ADD_SAT32_armv5e(opus_int32 a, opus_int32 b)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_ADD_SAT32\n\t"
michael@0:       "qadd %0, %1, %2\n\t"
michael@0:       : "=r"(res)
michael@0:       : "%r"(a), "r"(b)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_ADD_SAT32(a, b) (silk_ADD_SAT32_armv5e(a, b))
michael@0: 
michael@0: #undef silk_SUB_SAT32
michael@0: static OPUS_INLINE opus_int32 silk_SUB_SAT32_armv5e(opus_int32 a, opus_int32 b)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_SUB_SAT32\n\t"
michael@0:       "qsub %0, %1, %2\n\t"
michael@0:       : "=r"(res)
michael@0:       : "r"(a), "r"(b)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_SUB_SAT32(a, b) (silk_SUB_SAT32_armv5e(a, b))
michael@0: 
michael@0: #undef silk_CLZ16
michael@0: static OPUS_INLINE opus_int32 silk_CLZ16_armv5(opus_int16 in16)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_CLZ16\n\t"
michael@0:       "clz %0, %1;\n"
michael@0:       : "=r"(res)
michael@0:       : "r"(in16<<16|0x8000)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_CLZ16(in16) (silk_CLZ16_armv5(in16))
michael@0: 
michael@0: #undef silk_CLZ32
michael@0: static OPUS_INLINE opus_int32 silk_CLZ32_armv5(opus_int32 in32)
michael@0: {
michael@0:   int res;
michael@0:   __asm__(
michael@0:       "#silk_CLZ32\n\t"
michael@0:       "clz %0, %1\n\t"
michael@0:       : "=r"(res)
michael@0:       : "r"(in32)
michael@0:   );
michael@0:   return res;
michael@0: }
michael@0: #define silk_CLZ32(in32) (silk_CLZ32_armv5(in32))
michael@0: 
michael@0: #endif /* SILK_MACROS_ARMv5E_H */