174 lines
4.6 KiB
C
174 lines
4.6 KiB
C
|
/* Copyright (C) 2005 Analog Devices
|
||
|
|
Author: Jean-Marc Valin */
|
||
|
|
/**
|
||
|
|
@file fixed_bfin.h
|
||
|
|
@brief Blackfin fixed-point operations
|
||
|
|
*/
|
||
|
|
/*
|
||
|
|
Redistribution and use in source and binary forms, with or without
|
||
|
|
modification, are permitted provided that the following conditions
|
||
|
|
are met:
|
||
|
|
|
||
|
|
- Redistributions of source code must retain the above copyright
|
||
|
|
notice, this list of conditions and the following disclaimer.
|
||
|
|
|
||
|
|
- Redistributions in binary form must reproduce the above copyright
|
||
|
|
notice, this list of conditions and the following disclaimer in the
|
||
|
|
documentation and/or other materials provided with the distribution.
|
||
|
|
|
||
|
|
- Neither the name of the Xiph.org Foundation nor the names of its
|
||
|
|
contributors may be used to endorse or promote products derived from
|
||
|
|
this software without specific prior written permission.
|
||
|
|
|
||
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||
|
|
``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||
|
|
LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||
|
|
A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR
|
||
|
|
CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
||
|
|
EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
||
|
|
PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
||
|
|
PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
||
|
|
LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||
|
|
NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||
|
|
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#ifndef FIXED_BFIN_H
|
||
|
|
#define FIXED_BFIN_H
|
||
|
|
|
||
|
|
#undef PDIV32_16
|
||
|
|
static inline spx_word16_t PDIV32_16(spx_word32_t a, spx_word16_t b)
|
||
|
|
{
|
||
|
|
spx_word32_t res, bb;
|
||
|
|
bb = b;
|
||
|
|
a += b>>1;
|
||
|
|
__asm__ (
|
||
|
|
"P0 = 15;\n\t"
|
||
|
|
"R0 = %1;\n\t"
|
||
|
|
"R1 = %2;\n\t"
|
||
|
|
//"R0 = R0 + R1;\n\t"
|
||
|
|
"R0 <<= 1;\n\t"
|
||
|
|
"DIVS (R0, R1);\n\t"
|
||
|
|
"LOOP divide%= LC0 = P0;\n\t"
|
||
|
|
"LOOP_BEGIN divide%=;\n\t"
|
||
|
|
"DIVQ (R0, R1);\n\t"
|
||
|
|
"LOOP_END divide%=;\n\t"
|
||
|
|
"R0 = R0.L;\n\t"
|
||
|
|
"%0 = R0;\n\t"
|
||
|
|
: "=m" (res)
|
||
|
|
: "m" (a), "m" (bb)
|
||
|
|
: "P0", "R0", "R1", "cc");
|
||
|
|
return res;
|
||
|
|
}
|
||
|
|
|
||
|
|
#undef DIV32_16
|
||
|
|
static inline spx_word16_t DIV32_16(spx_word32_t a, spx_word16_t b)
|
||
|
|
{
|
||
|
|
spx_word32_t res, bb;
|
||
|
|
bb = b;
|
||
|
|
/* Make the roundinf consistent with the C version
|
||
|
|
(do we need to do that?)*/
|
||
|
|
if (a<0)
|
||
|
|
a += (b-1);
|
||
|
|
__asm__ (
|
||
|
|
"P0 = 15;\n\t"
|
||
|
|
"R0 = %1;\n\t"
|
||
|
|
"R1 = %2;\n\t"
|
||
|
|
"R0 <<= 1;\n\t"
|
||
|
|
"DIVS (R0, R1);\n\t"
|
||
|
|
"LOOP divide%= LC0 = P0;\n\t"
|
||
|
|
"LOOP_BEGIN divide%=;\n\t"
|
||
|
|
"DIVQ (R0, R1);\n\t"
|
||
|
|
"LOOP_END divide%=;\n\t"
|
||
|
|
"R0 = R0.L;\n\t"
|
||
|
|
"%0 = R0;\n\t"
|
||
|
|
: "=m" (res)
|
||
|
|
: "m" (a), "m" (bb)
|
||
|
|
: "P0", "R0", "R1", "cc");
|
||
|
|
return res;
|
||
|
|
}
|
||
|
|
|
||
|
|
#undef MAX16
|
||
|
|
static inline spx_word16_t MAX16(spx_word16_t a, spx_word16_t b)
|
||
|
|
{
|
||
|
|
spx_word32_t res;
|
||
|
|
__asm__ (
|
||
|
|
"%1 = %1.L (X);\n\t"
|
||
|
|
"%2 = %2.L (X);\n\t"
|
||
|
|
"%0 = MAX(%1,%2);"
|
||
|
|
: "=d" (res)
|
||
|
|
: "%d" (a), "d" (b)
|
||
|
|
);
|
||
|
|
return res;
|
||
|
|
}
|
||
|
|
|
||
|
|
#undef MULT16_32_Q15
|
||
|
|
static inline spx_word32_t MULT16_32_Q15(spx_word16_t a, spx_word32_t b)
|
||
|
|
{
|
||
|
|
spx_word32_t res;
|
||
|
|
__asm__
|
||
|
|
(
|
||
|
|
"A1 = %2.L*%1.L (M);\n\t"
|
||
|
|
"A1 = A1 >>> 15;\n\t"
|
||
|
|
"%0 = (A1 += %2.L*%1.H) ;\n\t"
|
||
|
|
: "=&W" (res), "=&d" (b)
|
||
|
|
: "d" (a), "1" (b)
|
||
|
|
: "A1"
|
||
|
|
);
|
||
|
|
return res;
|
||
|
|
}
|
||
|
|
|
||
|
|
#undef MAC16_32_Q15
|
||
|
|
static inline spx_word32_t MAC16_32_Q15(spx_word32_t c, spx_word16_t a, spx_word32_t b)
|
||
|
|
{
|
||
|
|
spx_word32_t res;
|
||
|
|
__asm__
|
||
|
|
(
|
||
|
|
"A1 = %2.L*%1.L (M);\n\t"
|
||
|
|
"A1 = A1 >>> 15;\n\t"
|
||
|
|
"%0 = (A1 += %2.L*%1.H);\n\t"
|
||
|
|
"%0 = %0 + %4;\n\t"
|
||
|
|
: "=&W" (res), "=&d" (b)
|
||
|
|
: "d" (a), "1" (b), "d" (c)
|
||
|
|
: "A1"
|
||
|
|
);
|
||
|
|
return res;
|
||
|
|
}
|
||
|
|
|
||
|
|
#undef MULT16_32_Q14
|
||
|
|
static inline spx_word32_t MULT16_32_Q14(spx_word16_t a, spx_word32_t b)
|
||
|
|
{
|
||
|
|
spx_word32_t res;
|
||
|
|
__asm__
|
||
|
|
(
|
||
|
|
"%2 <<= 1;\n\t"
|
||
|
|
"A1 = %1.L*%2.L (M);\n\t"
|
||
|
|
"A1 = A1 >>> 15;\n\t"
|
||
|
|
"%0 = (A1 += %1.L*%2.H);\n\t"
|
||
|
|
: "=W" (res), "=d" (a), "=d" (b)
|
||
|
|
: "1" (a), "2" (b)
|
||
|
|
: "A1"
|
||
|
|
);
|
||
|
|
return res;
|
||
|
|
}
|
||
|
|
|
||
|
|
#undef MAC16_32_Q14
|
||
|
|
static inline spx_word32_t MAC16_32_Q14(spx_word32_t c, spx_word16_t a, spx_word32_t b)
|
||
|
|
{
|
||
|
|
spx_word32_t res;
|
||
|
|
__asm__
|
||
|
|
(
|
||
|
|
"%1 <<= 1;\n\t"
|
||
|
|
"A1 = %2.L*%1.L (M);\n\t"
|
||
|
|
"A1 = A1 >>> 15;\n\t"
|
||
|
|
"%0 = (A1 += %2.L*%1.H);\n\t"
|
||
|
|
"%0 = %0 + %4;\n\t"
|
||
|
|
: "=&W" (res), "=&d" (b)
|
||
|
|
: "d" (a), "1" (b), "d" (c)
|
||
|
|
: "A1"
|
||
|
|
);
|
||
|
|
return res;
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|