/* * 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