 dd51dc5262
			
		
	
	
		dd51dc5262
		
	
	
	
	
		
			
			Instead of calling openrisc_env_get_cpu(), casting to CPU() via the ENV_GET_CPU() compatibility macro and casting back to OPENRISC_CPU(), just call openrisc_env_get_cpu() directly. ENV_GET_CPU() is meant as workaround for target-independent code only. Signed-off-by: Andreas Färber <afaerber@suse.de>
		
			
				
	
	
		
			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
 |