301 lines
14 KiB
C
301 lines
14 KiB
C
/*
|
|
* OpenRISC float helper routines
|
|
*
|
|
* Copyright (c) 2011-2012 Jia Liu <proljc@gmail.com>
|
|
* Feng Gao <gf91597@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"
|
|
#include "exception.h"
|
|
|
|
static inline uint32_t ieee_ex_to_openrisc(OpenRISCCPU *cpu, int fexcp)
|
|
{
|
|
int ret = 0;
|
|
if (fexcp) {
|
|
if (fexcp & float_flag_invalid) {
|
|
cpu->env.fpcsr |= FPCSR_IVF;
|
|
ret = 1;
|
|
}
|
|
if (fexcp & float_flag_overflow) {
|
|
cpu->env.fpcsr |= FPCSR_OVF;
|
|
ret = 1;
|
|
}
|
|
if (fexcp & float_flag_underflow) {
|
|
cpu->env.fpcsr |= FPCSR_UNF;
|
|
ret = 1;
|
|
}
|
|
if (fexcp & float_flag_divbyzero) {
|
|
cpu->env.fpcsr |= FPCSR_DZF;
|
|
ret = 1;
|
|
}
|
|
if (fexcp & float_flag_inexact) {
|
|
cpu->env.fpcsr |= FPCSR_IXF;
|
|
ret = 1;
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static inline void update_fpcsr(OpenRISCCPU *cpu)
|
|
{
|
|
int tmp = ieee_ex_to_openrisc(cpu,
|
|
get_float_exception_flags(&cpu->env.fp_status));
|
|
|
|
SET_FP_CAUSE(cpu->env.fpcsr, tmp);
|
|
if ((GET_FP_ENABLE(cpu->env.fpcsr) & tmp) &&
|
|
(cpu->env.fpcsr & FPCSR_FPEE)) {
|
|
helper_exception(&cpu->env, EXCP_FPE);
|
|
} else {
|
|
UPDATE_FP_FLAGS(cpu->env.fpcsr, tmp);
|
|
}
|
|
}
|
|
|
|
uint64_t HELPER(itofd)(CPUOpenRISCState *env, uint64_t val)
|
|
{
|
|
uint64_t itofd;
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env);
|
|
|
|
set_float_exception_flags(0, &cpu->env.fp_status);
|
|
itofd = int32_to_float64(val, &cpu->env.fp_status);
|
|
update_fpcsr(cpu);
|
|
|
|
return itofd;
|
|
}
|
|
|
|
uint32_t HELPER(itofs)(CPUOpenRISCState *env, uint32_t val)
|
|
{
|
|
uint32_t itofs;
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env);
|
|
|
|
set_float_exception_flags(0, &cpu->env.fp_status);
|
|
itofs = int32_to_float32(val, &cpu->env.fp_status);
|
|
update_fpcsr(cpu);
|
|
|
|
return itofs;
|
|
}
|
|
|
|
uint64_t HELPER(ftoid)(CPUOpenRISCState *env, uint64_t val)
|
|
{
|
|
uint64_t ftoid;
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env);
|
|
|
|
set_float_exception_flags(0, &cpu->env.fp_status);
|
|
ftoid = float32_to_int64(val, &cpu->env.fp_status);
|
|
update_fpcsr(cpu);
|
|
|
|
return ftoid;
|
|
}
|
|
|
|
uint32_t HELPER(ftois)(CPUOpenRISCState *env, uint32_t val)
|
|
{
|
|
uint32_t ftois;
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env);
|
|
|
|
set_float_exception_flags(0, &cpu->env.fp_status);
|
|
ftois = float32_to_int32(val, &cpu->env.fp_status);
|
|
update_fpcsr(cpu);
|
|
|
|
return ftois;
|
|
}
|
|
|
|
#define FLOAT_OP(name, p) void helper_float_##_##p(void)
|
|
|
|
#define FLOAT_CALC(name) \
|
|
uint64_t helper_float_ ## name ## _d(CPUOpenRISCState *env, \
|
|
uint64_t fdt0, uint64_t fdt1) \
|
|
{ \
|
|
uint64_t result; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
result = float64_ ## name(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return result; \
|
|
} \
|
|
\
|
|
uint32_t helper_float_ ## name ## _s(CPUOpenRISCState *env, \
|
|
uint32_t fdt0, uint32_t fdt1) \
|
|
{ \
|
|
uint32_t result; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
result = float32_ ## name(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return result; \
|
|
} \
|
|
|
|
FLOAT_CALC(add)
|
|
FLOAT_CALC(sub)
|
|
FLOAT_CALC(mul)
|
|
FLOAT_CALC(div)
|
|
FLOAT_CALC(rem)
|
|
#undef FLOAT_CALC
|
|
|
|
#define FLOAT_TERNOP(name1, name2) \
|
|
uint64_t helper_float_ ## name1 ## name2 ## _d(CPUOpenRISCState *env, \
|
|
uint64_t fdt0, \
|
|
uint64_t fdt1) \
|
|
{ \
|
|
uint64_t result, temp, hi, lo; \
|
|
uint32_t val1, val2; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
hi = env->fpmaddhi; \
|
|
lo = env->fpmaddlo; \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
result = float64_ ## name1(fdt0, fdt1, &cpu->env.fp_status); \
|
|
lo &= 0xffffffff; \
|
|
hi &= 0xffffffff; \
|
|
temp = (hi << 32) | lo; \
|
|
result = float64_ ## name2(result, temp, &cpu->env.fp_status); \
|
|
val1 = result >> 32; \
|
|
val2 = (uint32_t) (result & 0xffffffff); \
|
|
update_fpcsr(cpu); \
|
|
cpu->env.fpmaddlo = val2; \
|
|
cpu->env.fpmaddhi = val1; \
|
|
return 0; \
|
|
} \
|
|
\
|
|
uint32_t helper_float_ ## name1 ## name2 ## _s(CPUOpenRISCState *env, \
|
|
uint32_t fdt0, uint32_t fdt1) \
|
|
{ \
|
|
uint64_t result, temp, hi, lo; \
|
|
uint32_t val1, val2; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
hi = cpu->env.fpmaddhi; \
|
|
lo = cpu->env.fpmaddlo; \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
result = float64_ ## name1(fdt0, fdt1, &cpu->env.fp_status); \
|
|
temp = (hi << 32) | lo; \
|
|
result = float64_ ## name2(result, temp, &cpu->env.fp_status); \
|
|
val1 = result >> 32; \
|
|
val2 = (uint32_t) (result & 0xffffffff); \
|
|
update_fpcsr(cpu); \
|
|
cpu->env.fpmaddlo = val2; \
|
|
cpu->env.fpmaddhi = val1; \
|
|
return 0; \
|
|
}
|
|
|
|
FLOAT_TERNOP(mul, add)
|
|
#undef FLOAT_TERNOP
|
|
|
|
|
|
#define FLOAT_CMP(name) \
|
|
uint64_t helper_float_ ## name ## _d(CPUOpenRISCState *env, \
|
|
uint64_t fdt0, uint64_t fdt1) \
|
|
{ \
|
|
int res; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
res = float64_ ## name(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return res; \
|
|
} \
|
|
\
|
|
uint32_t helper_float_ ## name ## _s(CPUOpenRISCState *env, \
|
|
uint32_t fdt0, uint32_t fdt1)\
|
|
{ \
|
|
int res; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
res = float32_ ## name(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return res; \
|
|
}
|
|
|
|
FLOAT_CMP(le)
|
|
FLOAT_CMP(eq)
|
|
FLOAT_CMP(lt)
|
|
#undef FLOAT_CMP
|
|
|
|
|
|
#define FLOAT_CMPNE(name) \
|
|
uint64_t helper_float_ ## name ## _d(CPUOpenRISCState *env, \
|
|
uint64_t fdt0, uint64_t fdt1) \
|
|
{ \
|
|
int res; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
res = !float64_eq_quiet(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return res; \
|
|
} \
|
|
\
|
|
uint32_t helper_float_ ## name ## _s(CPUOpenRISCState *env, \
|
|
uint32_t fdt0, uint32_t fdt1) \
|
|
{ \
|
|
int res; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
res = !float32_eq_quiet(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return res; \
|
|
}
|
|
|
|
FLOAT_CMPNE(ne)
|
|
#undef FLOAT_CMPNE
|
|
|
|
#define FLOAT_CMPGT(name) \
|
|
uint64_t helper_float_ ## name ## _d(CPUOpenRISCState *env, \
|
|
uint64_t fdt0, uint64_t fdt1) \
|
|
{ \
|
|
int res; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
res = !float64_le(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return res; \
|
|
} \
|
|
\
|
|
uint32_t helper_float_ ## name ## _s(CPUOpenRISCState *env, \
|
|
uint32_t fdt0, uint32_t fdt1) \
|
|
{ \
|
|
int res; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
res = !float32_le(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return res; \
|
|
}
|
|
FLOAT_CMPGT(gt)
|
|
#undef FLOAT_CMPGT
|
|
|
|
#define FLOAT_CMPGE(name) \
|
|
uint64_t helper_float_ ## name ## _d(CPUOpenRISCState *env, \
|
|
uint64_t fdt0, uint64_t fdt1) \
|
|
{ \
|
|
int res; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
res = !float64_lt(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return res; \
|
|
} \
|
|
\
|
|
uint32_t helper_float_ ## name ## _s(CPUOpenRISCState *env, \
|
|
uint32_t fdt0, uint32_t fdt1) \
|
|
{ \
|
|
int res; \
|
|
OpenRISCCPU *cpu = openrisc_env_get_cpu(env); \
|
|
set_float_exception_flags(0, &cpu->env.fp_status); \
|
|
res = !float32_lt(fdt0, fdt1, &cpu->env.fp_status); \
|
|
update_fpcsr(cpu); \
|
|
return res; \
|
|
}
|
|
|
|
FLOAT_CMPGE(ge)
|
|
#undef FLOAT_CMPGE
|