/*

 *  Alpha emulation cpu micro-operations helpers for qemu.

 *

 *  Copyright (c) 2007 Jocelyn Mayer

 *

 * 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, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

 */

#include "exec.h"

#include "host-utils.h"

#include "softfloat.h"

#include "helper.h"

void helper_tb_flush (void)

{

    tlb_flush(env, 1);

}

/*****************************************************************************/

/* Exceptions processing helpers */

void helper_excp (int excp, int error)

{

    env->exception_index = excp;

    env->error_code = error;

    cpu_loop_exit();

}

uint64_t helper_amask (uint64_t arg)

{

    switch (env->implver) {

    case IMPLVER_2106x:

        /* EV4, EV45, LCA, LCA45 & EV5 */

        break;

    case IMPLVER_21164:

    case IMPLVER_21264:

    case IMPLVER_21364:

        arg &= ~env->amask;

        break;

    }

    return arg;

}

uint64_t helper_load_pcc (void)

{

    /* XXX: TODO */

    return 0;

}

uint64_t helper_load_implver (void)

{

    return env->implver;

}

uint64_t helper_load_fpcr (void)

{

    uint64_t ret = 0;

#ifdef CONFIG_SOFTFLOAT

    ret |= env->fp_status.float_exception_flags << 52;

    if (env->fp_status.float_exception_flags)

        ret |= 1ULL << 63;

    env->ipr[IPR_EXC_SUM] &= ~0x3E:

    env->ipr[IPR_EXC_SUM] |= env->fp_status.float_exception_flags << 1;

#endif

    switch (env->fp_status.float_rounding_mode) {

    case float_round_nearest_even:

        ret |= 2ULL << 58;

        break;

    case float_round_down:

        ret |= 1ULL << 58;

        break;

    case float_round_up:

        ret |= 3ULL << 58;

        break;

    case float_round_to_zero:

        break;

    }

    return ret;

}

void helper_store_fpcr (uint64_t val)

{

#ifdef CONFIG_SOFTFLOAT

    set_float_exception_flags((val >> 52) & 0x3F, &FP_STATUS);

#endif

    switch ((val >> 58) & 3) {

    case 0:

        set_float_rounding_mode(float_round_to_zero, &FP_STATUS);

        break;

    case 1:

        set_float_rounding_mode(float_round_down, &FP_STATUS);

        break;

    case 2:

        set_float_rounding_mode(float_round_nearest_even, &FP_STATUS);

        break;

    case 3:

        set_float_rounding_mode(float_round_up, &FP_STATUS);

        break;

    }

}

spinlock_t intr_cpu_lock = SPIN_LOCK_UNLOCKED;

uint64_t helper_rs(void)

{

    uint64_t tmp;

    spin_lock(&intr_cpu_lock);

    tmp = env->intr_flag;

    env->intr_flag = 1;

    spin_unlock(&intr_cpu_lock);

    return tmp;

}

uint64_t helper_rc(void)

{

    uint64_t tmp;

    spin_lock(&intr_cpu_lock);

    tmp = env->intr_flag;

    env->intr_flag = 0;

    spin_unlock(&intr_cpu_lock);

    return tmp;

}

uint64_t helper_addqv (uint64_t op1, uint64_t op2)

{

    uint64_t tmp = op1;

    op1 += op2;

    if (unlikely((tmp ^ op2 ^ (-1ULL)) & (tmp ^ op1) & (1ULL << 63))) {

        helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW);

    }

    return op1;

}

uint64_t helper_addlv (uint64_t op1, uint64_t op2)

{

    uint64_t tmp = op1;

    op1 = (uint32_t)(op1 + op2);

    if (unlikely((tmp ^ op2 ^ (-1UL)) & (tmp ^ op1) & (1UL << 31))) {

        helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW);

    }

    return op1;

}

uint64_t helper_subqv (uint64_t op1, uint64_t op2)

{

    uint64_t tmp = op1;

    op1 -= op2;

    if (unlikely(((~tmp) ^ op1 ^ (-1ULL)) & ((~tmp) ^ op2) & (1ULL << 63))) {

        helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW);

    }

    return op1;

}

uint64_t helper_sublv (uint64_t op1, uint64_t op2)

{

    uint64_t tmp = op1;

    op1 = (uint32_t)(op1 - op2);

    if (unlikely(((~tmp) ^ op1 ^ (-1UL)) & ((~tmp) ^ op2) & (1UL << 31))) {

        helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW);

    }

    return op1;

}

uint64_t helper_mullv (uint64_t op1, uint64_t op2)

{

    int64_t res = (int64_t)op1 * (int64_t)op2;

    if (unlikely((int32_t)res != res)) {

        helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW);

    }

    return (int64_t)((int32_t)res);

}

uint64_t helper_mulqv (uint64_t op1, uint64_t op2)

{

    uint64_t tl, th;

    muls64(&tl, &th, op1, op2);

    /* If th != 0 && th != -1, then we had an overflow */

    if (unlikely((th + 1) > 1)) {

        helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW);

    }

    return tl;

}

uint64_t helper_umulh (uint64_t op1, uint64_t op2)

{

    uint64_t tl, th;

    mulu64(&tl, &th, op1, op2);

    return th;

}

uint64_t helper_ctpop (uint64_t arg)

{

    return ctpop64(arg);

}

uint64_t helper_ctlz (uint64_t arg)

{

    return clz64(arg);

}

uint64_t helper_cttz (uint64_t arg)

{

    return ctz64(arg);

}

static always_inline uint64_t byte_zap (uint64_t op, uint8_t mskb)

{

    uint64_t mask;

    mask = 0;

    mask |= ((mskb >> 0) & 1) * 0x00000000000000FFULL;

    mask |= ((mskb >> 1) & 1) * 0x000000000000FF00ULL;

    mask |= ((mskb >> 2) & 1) * 0x0000000000FF0000ULL;

    mask |= ((mskb >> 3) & 1) * 0x00000000FF000000ULL;

    mask |= ((mskb >> 4) & 1) * 0x000000FF00000000ULL;

    mask |= ((mskb >> 5) & 1) * 0x0000FF0000000000ULL;

    mask |= ((mskb >> 6) & 1) * 0x00FF000000000000ULL;

    mask |= ((mskb >> 7) & 1) * 0xFF00000000000000ULL;

    return op & ~mask;

}

uint64_t helper_mskbl(uint64_t val, uint64_t mask)

{

    return byte_zap(val, 0x01 << (mask & 7));

}

uint64_t helper_insbl(uint64_t val, uint64_t mask)

{

    val <<= (mask & 7) * 8;

    return byte_zap(val, ~(0x01 << (mask & 7)));

}

uint64_t helper_mskwl(uint64_t val, uint64_t mask)

{

    return byte_zap(val, 0x03 << (mask & 7));

}

uint64_t helper_inswl(uint64_t val, uint64_t mask)

{

    val <<= (mask & 7) * 8;

    return byte_zap(val, ~(0x03 << (mask & 7)));

}

uint64_t helper_mskll(uint64_t val, uint64_t mask)

{

    return byte_zap(val, 0x0F << (mask & 7));

}

uint64_t helper_insll(uint64_t val, uint64_t mask)

{

    val <<= (mask & 7) * 8;

    return byte_zap(val, ~(0x0F << (mask & 7)));

}

uint64_t helper_zap(uint64_t val, uint64_t mask)

{

    return byte_zap(val, mask);

}

uint64_t helper_zapnot(uint64_t val, uint64_t mask)

{

    return byte_zap(val, ~mask);

}

uint64_t helper_mskql(uint64_t val, uint64_t mask)

{

    return byte_zap(val, 0xFF << (mask & 7));

}

uint64_t helper_insql(uint64_t val, uint64_t mask)

{

    val <<= (mask & 7) * 8;

    return byte_zap(val, ~(0xFF << (mask & 7)));

}

uint64_t helper_mskwh(uint64_t val, uint64_t mask)

{

    return byte_zap(val, (0x03 << (mask & 7)) >> 8);

}

uint64_t helper_inswh(uint64_t val, uint64_t mask)

{

    val >>= 64 - ((mask & 7) * 8);

    return byte_zap(val, ~((0x03 << (mask & 7)) >> 8));

}

uint64_t helper_msklh(uint64_t val, uint64_t mask)

{

    return byte_zap(val, (0x0F << (mask & 7)) >> 8);

}

uint64_t helper_inslh(uint64_t val, uint64_t mask)

{

    val >>= 64 - ((mask & 7) * 8);

    return byte_zap(val, ~((0x0F << (mask & 7)) >> 8));

}

uint64_t helper_mskqh(uint64_t val, uint64_t mask)

{

    return byte_zap(val, (0xFF << (mask & 7)) >> 8);

}

uint64_t helper_insqh(uint64_t val, uint64_t mask)

{

    val >>= 64 - ((mask & 7) * 8);

    return byte_zap(val, ~((0xFF << (mask & 7)) >> 8));

}

uint64_t helper_cmpbge (uint64_t op1, uint64_t op2)

{

    uint8_t opa, opb, res;

    int i;

    res = 0;

    for (i = 0; i < 8; i++) {

        opa = op1 >> (i * 8);

        opb = op2 >> (i * 8);

        if (opa >= opb)

            res |= 1 << i;

    }

    return res;

}

/* Floating point helpers */

/* F floating (VAX) */

static always_inline uint64_t float32_to_f (float32 fa)

{

    uint64_t r, exp, mant, sig;

    CPU_FloatU a;

    a.f = fa;

    sig = ((uint64_t)a.l & 0x80000000) << 32;

    exp = (a.l >> 23) & 0xff;

    mant = ((uint64_t)a.l & 0x007fffff) << 29;

    if (exp == 255) {

        /* NaN or infinity */

        r = 1; /* VAX dirty zero */

    } else if (exp == 0) {

        if (mant == 0) {

            /* Zero */

            r = 0;

        } else {

            /* Denormalized */

            r = sig | ((exp + 1) << 52) | mant;

        }

    } else {

        if (exp >= 253) {

            /* Overflow */

            r = 1; /* VAX dirty zero */

        } else {

            r = sig | ((exp + 2) << 52);

        }

    }

    return r;

}

static always_inline float32 f_to_float32 (uint64_t a)

{

    uint32_t exp, mant_sig;

    CPU_FloatU r;

    exp = ((a >> 55) & 0x80) | ((a >> 52) & 0x7f);

    mant_sig = ((a >> 32) & 0x80000000) | ((a >> 29) & 0x007fffff);

    if (unlikely(!exp && mant_sig)) {

        /* Reserved operands / Dirty zero */

        helper_excp(EXCP_OPCDEC, 0);

    }

    if (exp < 3) {

        /* Underflow */

        r.l = 0;

    } else {

        r.l = ((exp - 2) << 23) | mant_sig;

    }

    return r.f;

}

uint32_t helper_f_to_memory (uint64_t a)

{

    uint32_t r;

    r =  (a & 0x00001fffe0000000ull) >> 13;

    r |= (a & 0x07ffe00000000000ull) >> 45;

    r |= (a & 0xc000000000000000ull) >> 48;

    return r;

}

uint64_t helper_memory_to_f (uint32_t a)

{

    uint64_t r;

    r =  ((uint64_t)(a & 0x0000c000)) << 48;

    r |= ((uint64_t)(a & 0x003fffff)) << 45;

    r |= ((uint64_t)(a & 0xffff0000)) << 13;

    if (!(a & 0x00004000))

        r |= 0x7ll << 59;

    return r;

}

uint64_t helper_addf (uint64_t a, uint64_t b)

{

    float32 fa, fb, fr;

    fa = f_to_float32(a);

    fb = f_to_float32(b);

    fr = float32_add(fa, fb, &FP_STATUS);

    return float32_to_f(fr);

}

uint64_t helper_subf (uint64_t a, uint64_t b)

{

    float32 fa, fb, fr;

    fa = f_to_float32(a);

    fb = f_to_float32(b);

    fr = float32_sub(fa, fb, &FP_STATUS);

    return float32_to_f(fr);

}

uint64_t helper_mulf (uint64_t a, uint64_t b)

{

    float32 fa, fb, fr;

    fa = f_to_float32(a);

    fb = f_to_float32(b);

    fr = float32_mul(fa, fb, &FP_STATUS);

    return float32_to_f(fr);

}

uint64_t helper_divf (uint64_t a, uint64_t b)

{

    float32 fa, fb, fr;

    fa = f_to_float32(a);

    fb = f_to_float32(b);

    fr = float32_div(fa, fb, &FP_STATUS);

    return float32_to_f(fr);

}

uint64_t helper_sqrtf (uint64_t t)

{

    float32 ft, fr;

    ft = f_to_float32(t);

    fr = float32_sqrt(ft, &FP_STATUS);

    return float32_to_f(fr);

}

/* G floating (VAX) */

static always_inline uint64_t float64_to_g (float64 fa)

{

    uint64_t r, exp, mant, sig;

    CPU_DoubleU a;

    a.d = fa;

    sig = a.ll & 0x8000000000000000ull;

    exp = (a.ll >> 52) & 0x7ff;

    mant = a.ll & 0x000fffffffffffffull;

    if (exp == 2047) {

        /* NaN or infinity */

        r = 1; /* VAX dirty zero */

    } else if (exp == 0) {

        if (mant == 0) {

            /* Zero */

            r = 0;

        } else {

            /* Denormalized */

            r = sig | ((exp + 1) << 52) | mant;

        }

    } else {

        if (exp >= 2045) {

            /* Overflow */

            r = 1; /* VAX dirty zero */

        } else {

            r = sig | ((exp + 2) << 52);

        }

    }

    return r;

}

static always_inline float64 g_to_float64 (uint64_t a)

{

    uint64_t exp, mant_sig;

    CPU_DoubleU r;

    exp = (a >> 52) & 0x7ff;

    mant_sig = a & 0x800fffffffffffffull;

    if (!exp && mant_sig) {

        /* Reserved operands / Dirty zero */

        helper_excp(EXCP_OPCDEC, 0);

    }

    if (exp < 3) {

        /* Underflow */

        r.ll = 0;

    } else {

        r.ll = ((exp - 2) << 52) | mant_sig;

    }

    return r.d;

}