Archipelago » qemu

/*

 * 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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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_CPU(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