On Tue, Oct 16, 2012 at 12:39:05AM +0800, Jia Liu wrote:
> Add internal functions using by MIPS ASE DSP instructions.
>
> Signed-off-by: Jia Liu <pro...@gmail.com>
> ---
> target-mips/Makefile.objs | 2 +-
> target-mips/dsp_helper.c | 1086
> +++++++++++++++++++++++++++++++++++++++++++++
> 2 files changed, 1087 insertions(+), 1 deletion(-)
> create mode 100644 target-mips/dsp_helper.c
>
> diff --git a/target-mips/Makefile.objs b/target-mips/Makefile.objs
> index 3eeeeac..119c816 100644
> --- a/target-mips/Makefile.objs
> +++ b/target-mips/Makefile.objs
> @@ -1,2 +1,2 @@
> -obj-y += translate.o op_helper.o lmi_helper.o helper.o cpu.o
> +obj-y += translate.o dsp_helper.o op_helper.o lmi_helper.o helper.o cpu.o
> obj-$(CONFIG_SOFTMMU) += machine.o
> diff --git a/target-mips/dsp_helper.c b/target-mips/dsp_helper.c
> new file mode 100644
> index 0000000..1c656a0
> --- /dev/null
> +++ b/target-mips/dsp_helper.c
> @@ -0,0 +1,1086 @@
> +/*
> + * MIPS ASE DSP Instruction emulation helpers for QEMU.
> + *
> + * Copyright (c) 2012 Jia Liu <pro...@gmail.com>
> + * Dongxue Zhang <elat....@gmail.com>
> + * 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, see
> <http://www.gnu.org/licenses/>.
> + */
> +
> +#include "cpu.h"
> +#include "helper.h"
> +
> +/*** MIPS DSP internal functions begin ***/
> +#define MIPSDSP_ABS(x) (((x) >= 0) ? x : -x)
> +#define MIPSDSP_OVERFLOW(a, b, c, d) (!(!((a ^ b ^ -1) & (a ^ c) & d)))
Instead of the double not and the mask with d, you can pass the bit
number and do a shift. This would avoid passing huge constants like
0x8000000000000000ull and replace them by 63 instead.
> +
> +static inline void set_DSPControl_overflow_flag(uint32_t flag, int position,
> + CPUMIPSState *env)
> +{
> + env->active_tc.DSPControl |= (target_ulong)flag << position;
> +}
> +
> +static inline void set_DSPControl_carryflag(uint32_t flag, CPUMIPSState *env)
> +{
> + env->active_tc.DSPControl |= (target_ulong)flag << 13;
> +}
> +
> +static inline uint32_t get_DSPControl_carryflag(CPUMIPSState *env)
> +{
> + return (env->active_tc.DSPControl >> 13) & 0x01;
> +}
> +
> +static inline void set_DSPControl_24(uint32_t flag, int len, CPUMIPSState
> *env)
> +{
> + uint32_t filter;
> +
> + filter = ((0x01 << len) - 1) << 24;
> + filter = ~filter;
> +
> + env->active_tc.DSPControl &= filter;
> + env->active_tc.DSPControl |= (target_ulong)flag << 24;
> +}
> +
> +static inline uint32_t get_DSPControl_24(int len, CPUMIPSState *env)
> +{
> + uint32_t filter;
> +
> + filter = (0x01 << len) - 1;
> +
> + return (env->active_tc.DSPControl >> 24) & filter;
> +}
> +
> +static inline void set_DSPControl_pos(uint32_t pos, CPUMIPSState *env)
> +{
> + target_ulong dspc;
> +
> + dspc = env->active_tc.DSPControl;
> +#ifndef TARGET_MIPS64
> + dspc = dspc & 0xFFFFFFC0;
> + dspc |= pos;
> +#else
> + dspc = dspc & 0xFFFFFF80;
> + dspc |= pos;
> +#endif
> + env->active_tc.DSPControl = dspc;
> +}
> +
> +static inline uint32_t get_DSPControl_pos(CPUMIPSState *env)
> +{
> + target_ulong dspc;
> + uint32_t pos;
> +
> + dspc = env->active_tc.DSPControl;
> +
> +#ifndef TARGET_MIPS64
> + pos = dspc & 0x3F;
> +#else
> + pos = dspc & 0x7F;
> +#endif
> +
> + return pos;
> +}
> +
> +static inline void set_DSPControl_efi(uint32_t flag, CPUMIPSState *env)
> +{
> + env->active_tc.DSPControl &= 0xFFFFBFFF;
> + env->active_tc.DSPControl |= (target_ulong)flag << 14;
> +}
> +
> +#define DO_MIPS_SAT_ABS(size) \
> +static inline int##size##_t mipsdsp_sat_abs##size(int##size##_t a, \
> + CPUMIPSState *env) \
> +{ \
> + if (a == INT##size##_MIN) { \
> + set_DSPControl_overflow_flag(1, 20, env); \
> + return INT##size##_MAX; \
> + } else { \
> + return MIPSDSP_ABS(a); \
> + } \
> +}
> +DO_MIPS_SAT_ABS(8)
> +DO_MIPS_SAT_ABS(16)
> +DO_MIPS_SAT_ABS(32)
> +#undef DO_MIPS_SAT_ABS
> +
> +/* get sum value */
> +static inline int16_t mipsdsp_add_i16(int16_t a, int16_t b, CPUMIPSState
> *env)
> +{
> + int16_t tempI;
> +
> + tempI = a + b;
> +
> + if (MIPSDSP_OVERFLOW(a, b, tempI, 0x8000)) {
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return tempI;
> +}
> +
> +static inline int16_t mipsdsp_sat_add_i16(int16_t a, int16_t b,
> + CPUMIPSState *env)
> +{
> + int16_t tempS;
> +
> + tempS = a + b;
> +
> + if (MIPSDSP_OVERFLOW(a, b, tempS, 0x8000)) {
> + if (a > 0) {
> + tempS = 0x7FFF;
> + } else {
> + tempS = 0x8000;
> + }
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return tempS;
> +}
> +
> +static inline int32_t mipsdsp_sat_add_i32(int32_t a, int32_t b,
> + CPUMIPSState *env)
> +{
> + int32_t tempI;
> +
> + tempI = a + b;
> +
> + if (MIPSDSP_OVERFLOW(a, b, tempI, 0x80000000)) {
> + if (a > 0) {
> + tempI = 0x7FFFFFFF;
> + } else {
> + tempI = 0x80000000;
> + }
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return tempI;
> +}
> +
> +static inline uint8_t mipsdsp_add_u8(uint8_t a, uint8_t b, CPUMIPSState *env)
> +{
> + uint16_t temp;
> +
> + temp = (uint16_t)a + (uint16_t)b;
> +
> + if (temp & 0x0100) {
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp & 0xFF;
> +}
> +
> +static inline uint16_t mipsdsp_add_u16(uint16_t a, uint16_t b,
> + CPUMIPSState *env)
> +{
> + uint32_t temp;
> +
> + temp = (uint32_t)a + (uint32_t)b;
> +
> + if (temp & 0x00010000) {
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp & 0xFFFF;
> +}
> +
> +static inline uint8_t mipsdsp_sat_add_u8(uint8_t a, uint8_t b,
> + CPUMIPSState *env)
> +{
> + uint8_t result;
> + uint16_t temp;
> +
> + temp = (uint16_t)a + (uint16_t)b;
> + result = temp & 0xFF;
> +
> + if (0x0100 & temp) {
> + result = 0xFF;
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return result;
> +}
> +
> +static inline uint16_t mipsdsp_sat_add_u16(uint16_t a, uint16_t b,
> + CPUMIPSState *env)
> +{
> + uint16_t result;
> + uint32_t temp;
> +
> + temp = (uint32_t)a + (uint32_t)b;
> + result = temp & 0xFFFF;
> +
> + if (0x00010000 & temp) {
> + result = 0xFFFF;
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return result;
> +}
> +
> +static inline int32_t mipsdsp_sat32_acc_q31(int32_t acc, int32_t a,
> + CPUMIPSState *env)
> +{
> + int64_t temp;
> + int32_t temp32, temp31, result;
> + int64_t temp_sum;
> +
> +#ifndef TARGET_MIPS64
> + temp = ((uint64_t)env->active_tc.HI[acc] << 32) |
> + (uint64_t)env->active_tc.LO[acc];
> +#else
> + temp = (uint64_t)env->active_tc.LO[acc];
> +#endif
> +
> + temp_sum = (int64_t)a + temp;
> +
> + temp32 = (temp_sum >> 32) & 0x01;
> + temp31 = (temp_sum >> 31) & 0x01;
> + result = temp_sum & 0xFFFFFFFF;
> +
> + if (temp32 != temp31) {
> + if (temp32 == 0) {
> + result = 0x7FFFFFFF;
> + } else {
> + result = 0x80000000;
> + }
> + set_DSPControl_overflow_flag(1, 16 + acc, env);
> + }
> +
> + return result;
> +}
> +
> +/* a[0] is LO, a[1] is HI. */
> +static inline void mipsdsp_sat64_acc_add_q63(int64_t *ret,
> + int32_t ac,
> + int64_t *a,
> + CPUMIPSState *env)
> +{
> + int64_t temp[3];
> + int64_t acc[3];
> + int64_t temp_sum;
> +
> + temp[0] = a[0];
> + temp[1] = a[1];
> + if (temp[1] >= 0) {
> + temp[2] = 0x00;
> + } else {
> + temp[2] = ~0ull;
> + }
> +
> + acc[0] = env->active_tc.LO[ac];
> + acc[1] = env->active_tc.HI[ac];
> + if (acc[1] >= 0) {
> + acc[2] = 0x00;
> + } else {
> + acc[2] = ~0ull;
> + }
> +
> + temp_sum = temp[0] + acc[0];
> + if (((uint64_t)temp_sum < (uint64_t)temp[0]) &&
> + ((uint64_t)temp_sum < (uint64_t)acc[0])) {
> + temp[1] += 1;
> + if (temp[1] == 0) {
> + temp[2] += 1;
> + }
> + }
> + temp[0] = temp_sum;
> +
> + temp_sum = temp[1] + acc[1];
> + if (((uint64_t)temp_sum < (uint64_t)temp[1]) &&
> + ((uint64_t)temp_sum < (uint64_t)acc[1])) {
> + temp[2] += 1;
> + }
> +
> + if (MIPSDSP_OVERFLOW(temp[1], acc[1], temp_sum, INT64_MIN)) {
> + if (temp[1] > 0) {
> + ret[0] = 0x0;
> + ret[1] = 0x7FFFFFFFFFFFFFFFull;
> + } else {
> + ret[0] = 0x8000000000000000ull;
> + ret[1] = ~0ull;
> + }
> + set_DSPControl_overflow_flag(1, 16 + ac, env);
> + } else {
> + ret[0] = temp[0];
> + ret[1] = temp_sum;
> + }
> +}
> +
> +/* a[0] is LO, a[1] is HI. */
> +static inline void mipsdsp_sat64_acc_sub_q63(int64_t *ret,
> + int32_t ac,
> + int64_t *a,
> + CPUMIPSState *env)
> +{
> + uint32_t temp64, temp63;
> + int64_t temp[2];
> + int64_t acc[2];
> + int64_t temp_sum;
> +
> + temp[0] = a[0];
> + temp[1] = a[1];
> +
> + acc[0] = env->active_tc.LO[ac];
> + acc[1] = env->active_tc.HI[ac];
> +
> + temp_sum = acc[0] - temp[0];
> + if (MIPSDSP_OVERFLOW(acc[0], -temp[0], temp_sum, 0x8000000000000000ull))
> {
> + acc[1] -= 1;
> + }
> + acc[0] = temp_sum;
> +
> + temp_sum = acc[1] - temp[1];
> + acc[1] = temp_sum;
> +
> + temp64 = acc[1] & 0x01;
> + temp63 = (acc[0] >> 63) & 0x01;
> +
> + /* MIPSDSP_OVERFLOW only can check if a 64 bits sub is overflow,
> + * there are two 128 bits value subed then check the 63/64 bits are equal
> + * or not.*/
If you disagree with what I say, you can send mail, there is no need to
put it as a comment.
That said MIPSDSP_OVERFLOW doesn't work only on 64-bit values, it can
work other size, as it is done elsewhere in this patch. The only thing
it checked is the highest bit of the two arguments and the result.
Therefore if you pass the highest part of the values, it can work.
> + if (temp64 != temp63) {
> + if (temp64 == 1) {
> + ret[0] = 0x8000000000000000ull;
> + ret[1] = ~0ull;
> + } else {
> + ret[0] = 0x0;
> + ret[1] = 0x7FFFFFFFFFFFFFFFull;
> + }
> + set_DSPControl_overflow_flag(1, 16 + ac, env);
> + } else {
> + ret[0] = acc[0];
> + ret[1] = acc[1];
> + }
> +}
> +
> +static inline int32_t mipsdsp_mul_i16_i16(int16_t a, int16_t b,
> + CPUMIPSState *env)
> +{
> + int32_t temp;
> +
> + temp = (int32_t)a * (int32_t)b;
> +
> + if ((temp > 0x7FFF) || (temp < 0xFFFF8000)) {
> + set_DSPControl_overflow_flag(1, 21, env);
> + }
> + temp &= 0x0000FFFF;
> +
> + return temp;
> +}
> +
> +static inline int32_t mipsdsp_mul_u16_u16(int32_t a, int32_t b)
> +{
> + return a * b;
> +}
> +
> +static inline int32_t mipsdsp_mul_i32_i32(int32_t a, int32_t b)
> +{
> + return a * b;
> +}
> +
> +static inline int32_t mipsdsp_sat16_mul_i16_i16(int16_t a, int16_t b,
> + CPUMIPSState *env)
> +{
> + int32_t temp;
> +
> + temp = (int32_t)a * (int32_t)b;
> +
> + if (temp > 0x7FFF) {
> + temp = 0x00007FFF;
> + set_DSPControl_overflow_flag(1, 21, env);
> + } else if (temp < 0x00007FFF) {
> + temp = 0xFFFF8000;
> + set_DSPControl_overflow_flag(1, 21, env);
> + }
> + temp &= 0x0000FFFF;
> +
> + return temp;
> +}
> +
> +static inline int32_t mipsdsp_mul_q15_q15_overflowflag21(uint16_t a,
> uint16_t b,
> + CPUMIPSState *env)
> +{
> + int32_t temp;
> +
> + if ((a == 0x8000) && (b == 0x8000)) {
> + temp = 0x7FFFFFFF;
> + set_DSPControl_overflow_flag(1, 21, env);
> + } else {
> + temp = ((int32_t)(int16_t)a * (int32_t)(int16_t)b) << 1;
> + }
> +
> + return temp;
> +}
> +
> +/* right shift */
> +static inline uint8_t mipsdsp_rshift_u8(uint8_t a, target_ulong mov)
> +{
> + return a >> mov;
> +}
> +
> +static inline uint16_t mipsdsp_rshift_u16(uint16_t a, target_ulong mov)
> +{
> + return a >> mov;
> +}
> +
> +static inline int8_t mipsdsp_rashift8(int8_t a, target_ulong mov)
> +{
> + return a >> mov;
> +}
> +
> +static inline int16_t mipsdsp_rashift16(int16_t a, target_ulong mov)
> +{
> + return a >> mov;
> +}
> +
> +static inline int32_t mipsdsp_rashift32(int32_t a, target_ulong mov)
> +{
> + return a >> mov;
> +}
> +
> +static inline int16_t mipsdsp_rshift1_add_q16(int16_t a, int16_t b)
> +{
> + int32_t temp;
> +
> + temp = (int32_t)a + (int32_t)b;
> +
> + return (temp >> 1) & 0xFFFF;
> +}
> +
> +/* round right shift */
> +static inline int16_t mipsdsp_rrshift1_add_q16(int16_t a, int16_t b)
> +{
> + int32_t temp;
> +
> + temp = (int32_t)a + (int32_t)b;
> + temp += 1;
> +
> + return (temp >> 1) & 0xFFFF;
> +}
> +
> +static inline int32_t mipsdsp_rshift1_add_q32(int32_t a, int32_t b)
> +{
> + int64_t temp;
> +
> + temp = (int64_t)a + (int64_t)b;
> +
> + return (temp >> 1) & 0xFFFFFFFF;
> +}
> +
> +static inline int32_t mipsdsp_rrshift1_add_q32(int32_t a, int32_t b)
> +{
> + int64_t temp;
> +
> + temp = (int64_t)a + (int64_t)b;
> + temp += 1;
> +
> + return (temp >> 1) & 0xFFFFFFFF;
> +}
> +
> +static inline uint8_t mipsdsp_rshift1_add_u8(uint8_t a, uint8_t b)
> +{
> + uint16_t temp;
> +
> + temp = (uint16_t)a + (uint16_t)b;
> +
> + return (temp >> 1) & 0x00FF;
> +}
> +
> +static inline uint8_t mipsdsp_rrshift1_add_u8(uint8_t a, uint8_t b)
> +{
> + uint16_t temp;
> +
> + temp = (uint16_t)a + (uint16_t)b + 1;
> +
> + return (temp >> 1) & 0x00FF;
> +}
> +
> +static inline uint8_t mipsdsp_rshift1_sub_u8(uint8_t a, uint8_t b)
> +{
> + uint16_t temp;
> +
> + temp = (uint16_t)a - (uint16_t)b;
> +
> + return (temp >> 1) & 0x00FF;
> +}
> +
> +static inline uint8_t mipsdsp_rrshift1_sub_u8(uint8_t a, uint8_t b)
> +{
> + uint16_t temp;
> +
> + temp = (uint16_t)a - (uint16_t)b + 1;
> +
> + return (temp >> 1) & 0x00FF;
> +}
> +
> +static inline int64_t mipsdsp_rashift_short_acc(int32_t ac,
> + int32_t shift,
> + CPUMIPSState *env)
> +{
> + int32_t sign, temp31;
> + int64_t temp, acc;
> +
> + sign = (env->active_tc.HI[ac] >> 31) & 0x01;
> + acc = ((int64_t)env->active_tc.HI[ac] << 32) |
> + ((int64_t)env->active_tc.LO[ac] & 0xFFFFFFFF);
> + if (shift == 0) {
> + temp = acc;
> + } else {
> + if (sign == 0) {
> + temp = (((int64_t)0x01 << (32 - shift + 1)) - 1) & (acc >>
> shift);
> + } else {
> + temp = ((((int64_t)0x01 << (shift + 1)) - 1) << (32 - shift)) |
> + (acc >> shift);
> + }
> + }
> +
> + temp31 = (temp >> 31) & 0x01;
> + if (sign != temp31) {
> + set_DSPControl_overflow_flag(1, 23, env);
> + }
> +
> + return temp;
> +}
> +
> +/* 128 bits long. p[0] is LO, p[1] is HI. */
> +static inline void mipsdsp_rndrashift_short_acc(int64_t *p,
> + int32_t ac,
> + int32_t shift,
> + CPUMIPSState *env)
> +{
> + int64_t acc;
> +
> + acc = ((int64_t)env->active_tc.HI[ac] << 32) |
> + ((int64_t)env->active_tc.LO[ac] & 0xFFFFFFFF);
> + if (shift == 0) {
> + p[0] = acc << 1;
> + p[1] = (acc >> 63) & 0x01;
> + } else {
> + p[0] = acc >> (shift - 1);
> + p[1] = 0;
> + }
> +}
> +
> +/* 128 bits long. p[0] is LO, p[1] is HI */
> +static inline void mipsdsp_rashift_acc(uint64_t *p,
> + uint32_t ac,
> + uint32_t shift,
> + CPUMIPSState *env)
> +{
> + uint64_t tempB, tempA;
> +
> + tempB = env->active_tc.HI[ac];
> + tempA = env->active_tc.LO[ac];
> + shift = shift & 0x1F;
> +
> + if (shift == 0) {
> + p[1] = tempB;
> + p[0] = tempA;
> + } else {
> + p[0] = (tempB << (64 - shift)) | (tempA >> shift);
> + p[1] = (int64_t)tempB >> shift;
> + }
> +}
> +
> +/* 128 bits long. p[0] is LO, p[1] is HI , p[2] is sign of HI.*/
> +static inline void mipsdsp_rndrashift_acc(uint64_t *p,
> + uint32_t ac,
> + uint32_t shift,
> + CPUMIPSState *env)
> +{
> + int64_t tempB, tempA;
> +
> + tempB = env->active_tc.HI[ac];
> + tempA = env->active_tc.LO[ac];
> + shift = shift & 0x3F;
> +
> + if (shift == 0) {
> + p[2] = tempB >> 63;
> + p[1] = (tempB << 1) | (tempA >> 63);
> + p[0] = tempA << 1;
> + } else {
> + p[0] = (tempB << (65 - shift)) | (tempA >> (shift - 1));
> + p[1] = (int64_t)tempB >> (shift - 1);
> + if (tempB >= 0) {
> + p[2] = 0x0;
> + } else {
> + p[2] = ~0ull;
> + }
> + }
> +}
> +
> +static inline int32_t mipsdsp_mul_q15_q15(int32_t ac, uint16_t a, uint16_t b,
> + CPUMIPSState *env)
> +{
> + int32_t temp;
> +
> + if ((a == 0x8000) && (b == 0x8000)) {
> + temp = 0x7FFFFFFF;
> + set_DSPControl_overflow_flag(1, 16 + ac, env);
> + } else {
> + temp = ((uint32_t)a * (uint32_t)b) << 1;
> + }
> +
> + return temp;
> +}
> +
> +static inline int64_t mipsdsp_mul_q31_q31(int32_t ac, uint32_t a, uint32_t b,
> + CPUMIPSState *env)
> +{
> + uint64_t temp;
> +
> + if ((a == 0x80000000) && (b == 0x80000000)) {
> + temp = 0x7FFFFFFFFFFFFFFFull;
> + set_DSPControl_overflow_flag(1, 16 + ac, env);
> + } else {
> + temp = ((uint64_t)a * (uint64_t)b) << 1;
> + }
> +
> + return temp;
> +}
> +
> +static inline uint16_t mipsdsp_mul_u8_u8(uint8_t a, uint8_t b)
> +{
> + return (uint16_t)a * (uint16_t)b;
> +}
> +
> +static inline uint16_t mipsdsp_mul_u8_u16(uint8_t a, uint16_t b,
> + CPUMIPSState *env)
> +{
> + uint32_t tempI;
> +
> + tempI = (uint32_t)a * (uint32_t)b;
> + if (tempI > 0x0000FFFF) {
> + tempI = 0x0000FFFF;
> + set_DSPControl_overflow_flag(1, 21, env);
> + }
> +
> + return tempI & 0x0000FFFF;
> +}
> +
> +static inline uint64_t mipsdsp_mul_u32_u32(uint32_t a, uint32_t b)
> +{
> + return (uint64_t)a * (uint64_t)b;
> +}
> +
> +static inline int16_t mipsdsp_rndq15_mul_q15_q15(uint16_t a, uint16_t b,
> + CPUMIPSState *env)
> +{
> + uint32_t temp;
> +
> + if ((a == 0x8000) && (b == 0x8000)) {
> + temp = 0x7FFF0000;
> + set_DSPControl_overflow_flag(1, 21, env);
> + } else {
> + temp = (a * b) << 1;
> + temp = temp + 0x00008000;
> + }
> +
> + return (temp & 0xFFFF0000) >> 16;
> +}
> +
> +static inline int32_t mipsdsp_sat16_mul_q15_q15(uint16_t a, uint16_t b,
> + CPUMIPSState *env)
> +{
> + int32_t temp;
> +
> + if ((a == 0x8000) && (b == 0x8000)) {
> + temp = 0x7FFF0000;
> + set_DSPControl_overflow_flag(1, 21, env);
> + } else {
> + temp = ((uint32_t)a * (uint32_t)b);
> + temp = temp << 1;
> + }
> +
> + return (temp >> 16) & 0x0000FFFF;
> +}
> +
> +static inline uint16_t mipsdsp_trunc16_sat16_round(int32_t a,
> + CPUMIPSState *env)
> +{
> + int64_t temp;
> +
> + temp = (int32_t)a + 0x00008000;
> +
> + if (a > 0x7fff8000) {
> + temp = 0x7FFFFFFF;
> + set_DSPControl_overflow_flag(1, 22, env);
> + }
> +
> + return (temp >> 16) & 0xFFFF;
> +}
> +
> +static inline uint8_t mipsdsp_sat8_reduce_precision(uint16_t a,
> + CPUMIPSState *env)
> +{
> + uint16_t mag;
> + uint32_t sign;
> +
> + sign = (a >> 15) & 0x01;
> + mag = a & 0x7FFF;
> +
> + if (sign == 0) {
> + if (mag > 0x7F80) {
> + set_DSPControl_overflow_flag(1, 22, env);
> + return 0xFF;
> + } else {
> + return (mag >> 7) & 0xFFFF;
> + }
> + } else {
> + set_DSPControl_overflow_flag(1, 22, env);
> + return 0x00;
> + }
> +}
> +
> +static inline uint8_t mipsdsp_lshift8(uint8_t a, uint8_t s, CPUMIPSState
> *env)
> +{
> + uint8_t sign;
> + uint8_t discard;
> +
> + if (s == 0) {
> + return a;
> + } else {
> + sign = (a >> 7) & 0x01;
> + if (sign != 0) {
> + discard = (((0x01 << (8 - s)) - 1) << s) |
> + ((a >> (6 - (s - 1))) & ((0x01 << s) - 1));
> + } else {
> + discard = a >> (6 - (s - 1));
> + }
> +
> + if (discard != 0x00) {
> + set_DSPControl_overflow_flag(1, 22, env);
> + }
> + return a << s;
> + }
> +}
> +
> +static inline uint16_t mipsdsp_lshift16(uint16_t a, uint8_t s,
> + CPUMIPSState *env)
> +{
> + uint8_t sign;
> + uint16_t discard;
> +
> + if (s == 0) {
> + return a;
> + } else {
> + sign = (a >> 15) & 0x01;
> + if (sign != 0) {
> + discard = (((0x01 << (16 - s)) - 1) << s) |
> + ((a >> (14 - (s - 1))) & ((0x01 << s) - 1));
> + } else {
> + discard = a >> (14 - (s - 1));
> + }
> +
> + if ((discard != 0x0000) && (discard != 0xFFFF)) {
> + set_DSPControl_overflow_flag(1, 22, env);
> + }
> + return a << s;
> + }
> +}
> +
> +
> +static inline uint32_t mipsdsp_lshift32(uint32_t a, uint8_t s,
> + CPUMIPSState *env)
> +{
> + uint32_t discard;
> +
> + if (s == 0) {
> + return a;
> + } else {
> + discard = (int32_t)a >> (31 - (s - 1));
> +
> + if ((discard != 0x00000000) && (discard != 0xFFFFFFFF)) {
> + set_DSPControl_overflow_flag(1, 22, env);
> + }
> + return a << s;
> + }
> +}
> +
> +static inline uint16_t mipsdsp_sat16_lshift(uint16_t a, uint8_t s,
> + CPUMIPSState *env)
> +{
> + uint8_t sign;
> + uint16_t discard;
> +
> + if (s == 0) {
> + return a;
> + } else {
> + sign = (a >> 15) & 0x01;
> + if (sign != 0) {
> + discard = (((0x01 << (16 - s)) - 1) << s) |
> + ((a >> (14 - (s - 1))) & ((0x01 << s) - 1));
> + } else {
> + discard = a >> (14 - (s - 1));
> + }
> +
> + if ((discard != 0x0000) && (discard != 0xFFFF)) {
> + set_DSPControl_overflow_flag(1, 22, env);
> + return (sign == 0) ? 0x7FFF : 0x8000;
> + } else {
> + return a << s;
> + }
> + }
> +}
> +
> +static inline uint32_t mipsdsp_sat32_lshift(uint32_t a, uint8_t s,
> + CPUMIPSState *env)
> +{
> + uint8_t sign;
> + uint32_t discard;
> +
> + if (s == 0) {
> + return a;
> + } else {
> + sign = (a >> 31) & 0x01;
> + if (sign != 0) {
> + discard = (((0x01 << (32 - s)) - 1) << s) |
> + ((a >> (30 - (s - 1))) & ((0x01 << s) - 1));
> + } else {
> + discard = a >> (30 - (s - 1));
> + }
> +
> + if ((discard != 0x00000000) && (discard != 0xFFFFFFFF)) {
> + set_DSPControl_overflow_flag(1, 22, env);
> + return (sign == 0) ? 0x7FFFFFFF : 0x80000000;
> + } else {
> + return a << s;
> + }
> + }
> +}
> +
> +static inline uint8_t mipsdsp_rnd8_rashift(uint8_t a, uint8_t s)
> +{
> + uint32_t temp;
> +
> + if (s == 0) {
> + temp = (uint32_t)a << 1;
> + } else {
> + temp = (int32_t)(int8_t)a >> (s - 1);
> + }
> +
> + return (temp + 1) >> 1;
> +}
> +
> +static inline uint16_t mipsdsp_rnd16_rashift(uint16_t a, uint8_t s)
> +{
> + uint32_t temp;
> +
> + if (s == 0) {
> + temp = (uint32_t)a << 1;
> + } else {
> + temp = (int32_t)(int16_t)a >> (s - 1);
> + }
> +
> + return (temp + 1) >> 1;
> +}
> +
> +static inline uint32_t mipsdsp_rnd32_rashift(uint32_t a, uint8_t s)
> +{
> + int64_t temp;
> +
> + if (s == 0) {
> + temp = a << 1;
> + } else {
> + temp = (int64_t)(int32_t)a >> (s - 1);
> + }
> + temp += 1;
> +
> + return (temp >> 1) & 0x00000000FFFFFFFFull;
> +}
> +
> +static inline uint16_t mipsdsp_sub_i16(int16_t a, int16_t b, CPUMIPSState
> *env)
> +{
> + int16_t temp;
> +
> + temp = a - b;
> + if (MIPSDSP_OVERFLOW(a, -b, temp, 0x8000)) {
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp;
> +}
> +
> +static inline uint16_t mipsdsp_sat16_sub(int16_t a, int16_t b,
> + CPUMIPSState *env)
> +{
> + int16_t temp;
> +
> + temp = a - b;
> + if (MIPSDSP_OVERFLOW(a, -b, temp, 0x8000)) {
> + if (a > 0) {
> + temp = 0x7FFF;
> + } else {
> + temp = 0x8000;
> + }
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp;
> +}
> +
> +static inline uint32_t mipsdsp_sat32_sub(int32_t a, int32_t b,
> + CPUMIPSState *env)
> +{
> + int32_t temp;
> +
> + temp = a - b;
> + if (MIPSDSP_OVERFLOW(a, -b, temp, 0x80000000)) {
> + if (a > 0) {
> + temp = 0x7FFFFFFF;
> + } else {
> + temp = 0x80000000;
> + }
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp & 0x00000000FFFFFFFFull;
> +}
> +
> +static inline uint16_t mipsdsp_rshift1_sub_q16(int16_t a, int16_t b)
> +{
> + int32_t temp;
> +
> + temp = (int32_t)a - (int32_t)b;
> +
> + return (temp >> 1) & 0x0000FFFF;
> +}
> +
> +static inline uint16_t mipsdsp_rrshift1_sub_q16(int16_t a, int16_t b)
> +{
> + int32_t temp;
> +
> + temp = (int32_t)a - (int32_t)b;
> + temp += 1;
> +
> + return (temp >> 1) & 0x0000FFFF;
> +}
> +
> +static inline uint32_t mipsdsp_rshift1_sub_q32(int32_t a, int32_t b)
> +{
> + int64_t temp;
> +
> + temp = (int64_t)a - (int64_t)b;
> +
> + return (temp >> 1) & 0x00000000FFFFFFFFull;
> +}
> +
> +static inline uint32_t mipsdsp_rrshift1_sub_q32(int32_t a, int32_t b)
> +{
> + int64_t temp;
> +
> + temp = (int64_t)a - (int64_t)b;
> + temp += 1;
> +
> + return (temp >> 1) & 0x00000000FFFFFFFFull;
> +}
> +
> +static inline uint16_t mipsdsp_sub_u16_u16(uint16_t a, uint16_t b,
> + CPUMIPSState *env)
> +{
> + uint8_t temp16;
> + uint32_t temp;
> +
> + temp = (uint32_t)a - (uint32_t)b;
> + temp16 = (temp >> 16) & 0x01;
> + if (temp16 == 1) {
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> + return temp & 0x0000FFFF;
> +}
> +
> +static inline uint16_t mipsdsp_satu16_sub_u16_u16(uint16_t a, uint16_t b,
> + CPUMIPSState *env)
> +{
> + uint8_t temp16;
> + uint32_t temp;
> +
> + temp = (uint32_t)a - (uint32_t)b;
> + temp16 = (temp >> 16) & 0x01;
> +
> + if (temp16 == 1) {
> + temp = 0x0000;
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp & 0x0000FFFF;
> +}
> +
> +static inline uint8_t mipsdsp_sub_u8(uint8_t a, uint8_t b, CPUMIPSState *env)
> +{
> + uint8_t temp8;
> + uint16_t temp;
> +
> + temp = (uint16_t)a - (uint16_t)b;
> + temp8 = (temp >> 8) & 0x01;
> + if (temp8 == 1) {
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp & 0x00FF;
> +}
> +
> +static inline uint8_t mipsdsp_satu8_sub(uint8_t a, uint8_t b, CPUMIPSState
> *env)
> +{
> + uint8_t temp8;
> + uint16_t temp;
> +
> + temp = (uint16_t)a - (uint16_t)b;
> + temp8 = (temp >> 8) & 0x01;
> + if (temp8 == 1) {
> + temp = 0x00;
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp & 0x00FF;
> +}
> +
> +static inline uint32_t mipsdsp_sub32(int32_t a, int32_t b, CPUMIPSState *env)
> +{
> + int32_t temp;
> +
> + temp = a - b;
> + if (MIPSDSP_OVERFLOW(a, -b, temp, 0x80000000)) {
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp;
> +}
> +
> +static inline int32_t mipsdsp_add_i32(int32_t a, int32_t b, CPUMIPSState
> *env)
> +{
> + int32_t temp;
> +
> + temp = a + b;
> +
> + if (MIPSDSP_OVERFLOW(a, b, temp, 0x80000000)) {
> + set_DSPControl_overflow_flag(1, 20, env);
> + }
> +
> + return temp;
> +}
> +
> +static inline int32_t mipsdsp_cmp_eq(uint32_t a, uint32_t b)
> +{
> + return a == b;
> +}
> +
> +static inline int32_t mipsdsp_cmp_le(uint32_t a, uint32_t b)
> +{
> + return a <= b;
> +}
> +
> +static inline int32_t mipsdsp_cmp_lt(uint32_t a, uint32_t b)
> +{
> + return a < b;
> +}
> +/*** MIPS DSP internal functions end ***/
> --
> 1.7.10.2 (Apple Git-33)
>
>
--
Aurelien Jarno GPG: 1024D/F1BCDB73
aurel...@aurel32.net http://www.aurel32.net
