|
|
|
|
/*
|
|
|
|
|
* simple math operations
|
|
|
|
|
* Copyright (c) 2006 Michael Niedermayer <michaelni@gmx.at> et al
|
|
|
|
|
*
|
|
|
|
|
* This library is free software; you can redistribute it and/or
|
|
|
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
|
|
|
* License as published by the Free Software Foundation; either
|
|
|
|
|
* version 2 of the License, or (at your option) any later version.
|
|
|
|
|
*
|
|
|
|
|
* This library is distributed in the hope that it will be useful,
|
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
|
* Lesser General Public License for more details.
|
|
|
|
|
*
|
|
|
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
|
|
|
* License along with this library; if not, write to the Free Software
|
|
|
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#ifdef FRAC_BITS
|
|
|
|
|
# define MULL(a, b) \
|
|
|
|
|
({ int lo, hi;\
|
|
|
|
|
asm("smull %0, %1, %2, %3 \n\t"\
|
|
|
|
|
"mov %0, %0, lsr %4\n\t"\
|
|
|
|
|
"add %1, %0, %1, lsl %5\n\t"\
|
|
|
|
|
: "=&r"(lo), "=&r"(hi)\
|
|
|
|
|
: "r"(b), "r"(a), "i"(FRAC_BITS), "i"(32-FRAC_BITS));\
|
|
|
|
|
hi; })
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#define MULH(a, b) \
|
|
|
|
|
({ int lo, hi;\
|
|
|
|
|
asm ("smull %0, %1, %2, %3" : "=&r"(lo), "=&r"(hi) : "r"(b), "r"(a));\
|
|
|
|
|
hi; })
|
|
|
|
|
|
|
|
|
|
#if defined(HAVE_ARMV5TE)
|
|
|
|
|
|
|
|
|
|
/* signed 16x16 -> 32 multiply add accumulate */
|
|
|
|
|
# define MAC16(rt, ra, rb) \
|
|
|
|
|
asm ("smlabb %0, %2, %3, %0" : "=r" (rt) : "0" (rt), "r" (ra), "r" (rb));
|
|
|
|
|
/* signed 16x16 -> 32 multiply */
|
|
|
|
|
# define MUL16(ra, rb) \
|
|
|
|
|
({ int __rt; \
|
|
|
|
|
asm ("smulbb %0, %1, %2" : "=r" (__rt) : "r" (ra), "r" (rb)); \
|
|
|
|
|
__rt; })
|
|
|
|
|
|
|
|
|
|
#endif
|
