/*

 *  PowerPC emulation helpers for qemu.

 *

 *  Copyright (c) 2003-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 "helper.h"

#include "helper_regs.h"

//#define DEBUG_OP

//#define DEBUG_EXCEPTIONS

//#define DEBUG_SOFTWARE_TLB

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

/* Exceptions processing helpers */

void helper_raise_exception_err (uint32_t exception, uint32_t error_code)

{

#if 0

    printf("Raise exception %3x code : %d\n", exception, error_code);

#endif

    env->exception_index = exception;

    env->error_code = error_code;

    cpu_loop_exit();

}

void helper_raise_exception (uint32_t exception)

{

    helper_raise_exception_err(exception, 0);

}

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

/* Registers load and stores */

target_ulong helper_load_cr (void)

{

    return (env->crf[0] << 28) |

           (env->crf[1] << 24) |

           (env->crf[2] << 20) |

           (env->crf[3] << 16) |

           (env->crf[4] << 12) |

           (env->crf[5] << 8) |

           (env->crf[6] << 4) |

           (env->crf[7] << 0);

}

void helper_store_cr (target_ulong val, uint32_t mask)

{

    int i, sh;

    for (i = 0, sh = 7; i < 8; i++, sh--) {

        if (mask & (1 << sh))

            env->crf[i] = (val >> (sh * 4)) & 0xFUL;

    }

}

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

/* SPR accesses */

void helper_load_dump_spr (uint32_t sprn)

{

    if (loglevel != 0) {

        fprintf(logfile, "Read SPR %d %03x => " ADDRX "\n",

                sprn, sprn, env->spr[sprn]);

    }

}

void helper_store_dump_spr (uint32_t sprn)

{

    if (loglevel != 0) {

        fprintf(logfile, "Write SPR %d %03x <= " ADDRX "\n",

                sprn, sprn, env->spr[sprn]);

    }

}

target_ulong helper_load_tbl (void)

{

    return cpu_ppc_load_tbl(env);

}

target_ulong helper_load_tbu (void)

{

    return cpu_ppc_load_tbu(env);

}

target_ulong helper_load_atbl (void)

{

    return cpu_ppc_load_atbl(env);

}

target_ulong helper_load_atbu (void)

{

    return cpu_ppc_load_atbu(env);

}

target_ulong helper_load_601_rtcl (void)

{

    return cpu_ppc601_load_rtcl(env);

}

target_ulong helper_load_601_rtcu (void)

{

    return cpu_ppc601_load_rtcu(env);

}

#if !defined(CONFIG_USER_ONLY)

#if defined (TARGET_PPC64)

void helper_store_asr (target_ulong val)

{

    ppc_store_asr(env, val);

}

#endif

void helper_store_sdr1 (target_ulong val)

{

    ppc_store_sdr1(env, val);

}

void helper_store_tbl (target_ulong val)

{

    cpu_ppc_store_tbl(env, val);

}

void helper_store_tbu (target_ulong val)

{

    cpu_ppc_store_tbu(env, val);

}

void helper_store_atbl (target_ulong val)

{

    cpu_ppc_store_atbl(env, val);

}

void helper_store_atbu (target_ulong val)

{

    cpu_ppc_store_atbu(env, val);

}

void helper_store_601_rtcl (target_ulong val)

{

    cpu_ppc601_store_rtcl(env, val);

}

void helper_store_601_rtcu (target_ulong val)

{

    cpu_ppc601_store_rtcu(env, val);

}

target_ulong helper_load_decr (void)

{

    return cpu_ppc_load_decr(env);

}

void helper_store_decr (target_ulong val)

{

    cpu_ppc_store_decr(env, val);

}

void helper_store_hid0_601 (target_ulong val)

{

    target_ulong hid0;

    hid0 = env->spr[SPR_HID0];

    if ((val ^ hid0) & 0x00000008) {

        /* Change current endianness */

        env->hflags &= ~(1 << MSR_LE);

        env->hflags_nmsr &= ~(1 << MSR_LE);

        env->hflags_nmsr |= (1 << MSR_LE) & (((val >> 3) & 1) << MSR_LE);

        env->hflags |= env->hflags_nmsr;

        if (loglevel != 0) {

            fprintf(logfile, "%s: set endianness to %c => " ADDRX "\n",

                    __func__, val & 0x8 ? 'l' : 'b', env->hflags);

        }

    }

    env->spr[SPR_HID0] = (uint32_t)val;

}

void helper_store_403_pbr (uint32_t num, target_ulong value)

{

    if (likely(env->pb[num] != value)) {

        env->pb[num] = value;

        /* Should be optimized */

        tlb_flush(env, 1);

    }

}

target_ulong helper_load_40x_pit (void)

{

    return load_40x_pit(env);

}

void helper_store_40x_pit (target_ulong val)

{

    store_40x_pit(env, val);

}

void helper_store_40x_dbcr0 (target_ulong val)

{

    store_40x_dbcr0(env, val);

}

void helper_store_40x_sler (target_ulong val)

{

    store_40x_sler(env, val);

}

void helper_store_booke_tcr (target_ulong val)

{

    store_booke_tcr(env, val);

}

void helper_store_booke_tsr (target_ulong val)

{

    store_booke_tsr(env, val);

}

void helper_store_ibatu (uint32_t nr, target_ulong val)

{

    ppc_store_ibatu(env, nr, val);

}

void helper_store_ibatl (uint32_t nr, target_ulong val)

{

    ppc_store_ibatl(env, nr, val);

}

void helper_store_dbatu (uint32_t nr, target_ulong val)

{

    ppc_store_dbatu(env, nr, val);

}

void helper_store_dbatl (uint32_t nr, target_ulong val)

{

    ppc_store_dbatl(env, nr, val);

}

void helper_store_601_batl (uint32_t nr, target_ulong val)

{

    ppc_store_ibatl_601(env, nr, val);

}

void helper_store_601_batu (uint32_t nr, target_ulong val)

{

    ppc_store_ibatu_601(env, nr, val);

}

#endif

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

/* Memory load and stores */

static always_inline target_ulong addr_add(target_ulong addr, target_long arg)

{

#if defined(TARGET_PPC64)

        if (!msr_sf)

            return (uint32_t)(addr + arg);

        else

#endif

            return addr + arg;

}

void helper_lmw (target_ulong addr, uint32_t reg)

{

    for (; reg < 32; reg++) {

        if (msr_le)

            env->gpr[reg] = bswap32(ldl(addr));

        else

            env->gpr[reg] = ldl(addr);

	addr = addr_add(addr, 4);

    }

}

void helper_stmw (target_ulong addr, uint32_t reg)

{

    for (; reg < 32; reg++) {

        if (msr_le)

            stl(addr, bswap32((uint32_t)env->gpr[reg]));

        else

            stl(addr, (uint32_t)env->gpr[reg]);

	addr = addr_add(addr, 4);

    }

}

void helper_lsw(target_ulong addr, uint32_t nb, uint32_t reg)

{

    int sh;

    for (; nb > 3; nb -= 4) {

        env->gpr[reg] = ldl(addr);

        reg = (reg + 1) % 32;

	addr = addr_add(addr, 4);

    }

    if (unlikely(nb > 0)) {

        env->gpr[reg] = 0;

        for (sh = 24; nb > 0; nb--, sh -= 8) {

            env->gpr[reg] |= ldub(addr) << sh;

	    addr = addr_add(addr, 1);

        }

    }

}

/* PPC32 specification says we must generate an exception if

 * rA is in the range of registers to be loaded.

 * In an other hand, IBM says this is valid, but rA won't be loaded.

 * For now, I'll follow the spec...

 */

void helper_lswx(target_ulong addr, uint32_t reg, uint32_t ra, uint32_t rb)

{

    if (likely(xer_bc != 0)) {

        if (unlikely((ra != 0 && reg < ra && (reg + xer_bc) > ra) ||

                     (reg < rb && (reg + xer_bc) > rb))) {

            helper_raise_exception_err(POWERPC_EXCP_PROGRAM,

                                       POWERPC_EXCP_INVAL |

                                       POWERPC_EXCP_INVAL_LSWX);

        } else {

            helper_lsw(addr, xer_bc, reg);

        }

    }

}

void helper_stsw(target_ulong addr, uint32_t nb, uint32_t reg)

{

    int sh;

    for (; nb > 3; nb -= 4) {

        stl(addr, env->gpr[reg]);

        reg = (reg + 1) % 32;

	addr = addr_add(addr, 4);

    }

    if (unlikely(nb > 0)) {

        for (sh = 24; nb > 0; nb--, sh -= 8)

            stb(addr, (env->gpr[reg] >> sh) & 0xFF);

	    addr = addr_add(addr, 1);

    }

}

static void do_dcbz(target_ulong addr, int dcache_line_size)

{

    addr &= ~(dcache_line_size - 1);

    int i;

    for (i = 0 ; i < dcache_line_size ; i += 4) {

        stl(addr + i , 0);

    }

    if (env->reserve == addr)

        env->reserve = (target_ulong)-1ULL;

}

void helper_dcbz(target_ulong addr)

{

    do_dcbz(addr, env->dcache_line_size);

}

void helper_dcbz_970(target_ulong addr)

{

    if (((env->spr[SPR_970_HID5] >> 7) & 0x3) == 1)

        do_dcbz(addr, 32);

    else

        do_dcbz(addr, env->dcache_line_size);

}

void helper_icbi(target_ulong addr)

{

    uint32_t tmp;

    addr &= ~(env->dcache_line_size - 1);

    /* Invalidate one cache line :

     * PowerPC specification says this is to be treated like a load

     * (not a fetch) by the MMU. To be sure it will be so,

     * do the load "by hand".

     */

    tmp = ldl(addr);

    tb_invalidate_page_range(addr, addr + env->icache_line_size);

}

// XXX: to be tested

target_ulong helper_lscbx (target_ulong addr, uint32_t reg, uint32_t ra, uint32_t rb)

{

    int i, c, d;

    d = 24;

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

        c = ldub(addr);

	addr = addr_add(addr, 1);

        /* ra (if not 0) and rb are never modified */

        if (likely(reg != rb && (ra == 0 || reg != ra))) {

            env->gpr[reg] = (env->gpr[reg] & ~(0xFF << d)) | (c << d);

        }

        if (unlikely(c == xer_cmp))

            break;

        if (likely(d != 0)) {

            d -= 8;

        } else {

            d = 24;

            reg++;

            reg = reg & 0x1F;

        }

    }

    return i;

}

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

/* Fixed point operations helpers */

#if defined(TARGET_PPC64)

/* multiply high word */

uint64_t helper_mulhd (uint64_t arg1, uint64_t arg2)

{

    uint64_t tl, th;

    muls64(&tl, &th, arg1, arg2);

    return th;

}

/* multiply high word unsigned */

uint64_t helper_mulhdu (uint64_t arg1, uint64_t arg2)

{

    uint64_t tl, th;

    mulu64(&tl, &th, arg1, arg2);

    return th;

}

uint64_t helper_mulldo (uint64_t arg1, uint64_t arg2)

{

    int64_t th;

    uint64_t tl;

    muls64(&tl, (uint64_t *)&th, arg1, arg2);

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

    if (likely((uint64_t)(th + 1) <= 1)) {

        env->xer &= ~(1 << XER_OV);

    } else {

        env->xer |= (1 << XER_OV) | (1 << XER_SO);

    }

    return (int64_t)tl;

}

#endif

target_ulong helper_cntlzw (target_ulong t)

{

    return clz32(t);

}

#if defined(TARGET_PPC64)

target_ulong helper_cntlzd (target_ulong t)

{

    return clz64(t);

}

#endif

/* shift right arithmetic helper */

target_ulong helper_sraw (target_ulong value, target_ulong shift)

{

    int32_t ret;

    if (likely(!(shift & 0x20))) {

        if (likely((uint32_t)shift != 0)) {

            shift &= 0x1f;

            ret = (int32_t)value >> shift;

            if (likely(ret >= 0 || (value & ((1 << shift) - 1)) == 0)) {

                env->xer &= ~(1 << XER_CA);

            } else {

                env->xer |= (1 << XER_CA);

            }

        } else {

            ret = (int32_t)value;

            env->xer &= ~(1 << XER_CA);

        }

    } else {

        ret = (int32_t)value >> 31;

        if (ret) {

            env->xer |= (1 << XER_CA);

        } else {

            env->xer &= ~(1 << XER_CA);

        }

    }

    return (target_long)ret;

}

#if defined(TARGET_PPC64)

target_ulong helper_srad (target_ulong value, target_ulong shift)

{

    int64_t ret;

    if (likely(!(shift & 0x40))) {

        if (likely((uint64_t)shift != 0)) {

            shift &= 0x3f;

            ret = (int64_t)value >> shift;

            if (likely(ret >= 0 || (value & ((1 << shift) - 1)) == 0)) {

                env->xer &= ~(1 << XER_CA);

            } else {

                env->xer |= (1 << XER_CA);

            }

        } else {

            ret = (int64_t)value;

            env->xer &= ~(1 << XER_CA);

        }

    } else {

        ret = (int64_t)value >> 63;

        if (ret) {

            env->xer |= (1 << XER_CA);

        } else {

            env->xer &= ~(1 << XER_CA);

        }

    }

    return ret;

}

#endif

target_ulong helper_popcntb (target_ulong val)

{

    val = (val & 0x55555555) + ((val >>  1) & 0x55555555);

    val = (val & 0x33333333) + ((val >>  2) & 0x33333333);

    val = (val & 0x0f0f0f0f) + ((val >>  4) & 0x0f0f0f0f);

    return val;

}

#if defined(TARGET_PPC64)

target_ulong helper_popcntb_64 (target_ulong val)

{