Archipelago » qemu

/*

 *  i386 micro operations

 * 

 *  Copyright (c) 2003 Fabrice Bellard

 *

 * 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-i386.h"

/* NOTE: data are not static to force relocation generation by GCC */

uint8_t parity_table[256] = {

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    CC_P, 0, 0, CC_P, 0, CC_P, CC_P, 0,

    0, CC_P, CC_P, 0, CC_P, 0, 0, CC_P,

};

/* modulo 17 table */

const uint8_t rclw_table[32] = {

    0, 1, 2, 3, 4, 5, 6, 7, 

    8, 9,10,11,12,13,14,15,

   16, 0, 1, 2, 3, 4, 5, 6,

    7, 8, 9,10,11,12,13,14,

};

/* modulo 9 table */

const uint8_t rclb_table[32] = {

    0, 1, 2, 3, 4, 5, 6, 7, 

    8, 0, 1, 2, 3, 4, 5, 6,

    7, 8, 0, 1, 2, 3, 4, 5, 

    6, 7, 8, 0, 1, 2, 3, 4,

};

#ifdef USE_X86LDOUBLE

/* an array of Intel 80-bit FP constants, to be loaded via integer ops */

typedef unsigned short f15ld[5];

const f15ld f15rk[] =

{

/*0*/        {0x0000,0x0000,0x0000,0x0000,0x0000},

/*1*/        {0x0000,0x0000,0x0000,0x8000,0x3fff},

/*pi*/        {0xc235,0x2168,0xdaa2,0xc90f,0x4000},

/*lg2*/        {0xf799,0xfbcf,0x9a84,0x9a20,0x3ffd},

/*ln2*/        {0x79ac,0xd1cf,0x17f7,0xb172,0x3ffe},

/*l2e*/        {0xf0bc,0x5c17,0x3b29,0xb8aa,0x3fff},

/*l2t*/        {0x8afe,0xcd1b,0x784b,0xd49a,0x4000}

};

#else

/* the same, 64-bit version */

typedef unsigned short f15ld[4];

const f15ld f15rk[] =

{

#ifndef WORDS_BIGENDIAN

/*0*/        {0x0000,0x0000,0x0000,0x0000},

/*1*/        {0x0000,0x0000,0x0000,0x3ff0},

/*pi*/        {0x2d18,0x5444,0x21fb,0x4009},

/*lg2*/        {0x79ff,0x509f,0x4413,0x3fd3},

/*ln2*/        {0x39ef,0xfefa,0x2e42,0x3fe6},

/*l2e*/        {0x82fe,0x652b,0x1547,0x3ff7},

/*l2t*/        {0xa371,0x0979,0x934f,0x400a}

#else

/*0*/   {0x0000,0x0000,0x0000,0x0000},

/*1*/   {0x3ff0,0x0000,0x0000,0x0000},

/*pi*/  {0x4009,0x21fb,0x5444,0x2d18},

/*lg2*/        {0x3fd3,0x4413,0x509f,0x79ff},

/*ln2*/        {0x3fe6,0x2e42,0xfefa,0x39ef},

/*l2e*/        {0x3ff7,0x1547,0x652b,0x82fe},

/*l2t*/        {0x400a,0x934f,0x0979,0xa371}

#endif

};

#endif

/* n must be a constant to be efficient */

static inline int lshift(int x, int n)

{

    if (n >= 0)

        return x << n;

    else

        return x >> (-n);

}

/* we define the various pieces of code used by the JIT */

#define REG EAX

#define REGNAME _EAX

#include "opreg_template.h"

#undef REG

#undef REGNAME

#define REG ECX

#define REGNAME _ECX

#include "opreg_template.h"

#undef REG

#undef REGNAME

#define REG EDX

#define REGNAME _EDX

#include "opreg_template.h"

#undef REG

#undef REGNAME

#define REG EBX

#define REGNAME _EBX

#include "opreg_template.h"

#undef REG

#undef REGNAME

#define REG ESP

#define REGNAME _ESP

#include "opreg_template.h"

#undef REG

#undef REGNAME

#define REG EBP

#define REGNAME _EBP

#include "opreg_template.h"

#undef REG

#undef REGNAME

#define REG ESI

#define REGNAME _ESI

#include "opreg_template.h"

#undef REG

#undef REGNAME

#define REG EDI

#define REGNAME _EDI

#include "opreg_template.h"

#undef REG

#undef REGNAME

/* operations with flags */

void OPPROTO op_addl_T0_T1_cc(void)

{

    CC_SRC = T0;

    T0 += T1;

    CC_DST = T0;

}

void OPPROTO op_orl_T0_T1_cc(void)

{

    T0 |= T1;

    CC_DST = T0;

}

void OPPROTO op_andl_T0_T1_cc(void)

{

    T0 &= T1;

    CC_DST = T0;

}

void OPPROTO op_subl_T0_T1_cc(void)

{

    CC_SRC = T0;

    T0 -= T1;

    CC_DST = T0;

}

void OPPROTO op_xorl_T0_T1_cc(void)

{

    T0 ^= T1;

    CC_DST = T0;

}

void OPPROTO op_cmpl_T0_T1_cc(void)

{

    CC_SRC = T0;

    CC_DST = T0 - T1;

}

void OPPROTO op_negl_T0_cc(void)

{

    CC_SRC = 0;

    T0 = -T0;

    CC_DST = T0;

}

void OPPROTO op_incl_T0_cc(void)

{

    CC_SRC = cc_table[CC_OP].compute_c();

    T0++;

    CC_DST = T0;

}

void OPPROTO op_decl_T0_cc(void)

{

    CC_SRC = cc_table[CC_OP].compute_c();

    T0--;

    CC_DST = T0;

}

void OPPROTO op_testl_T0_T1_cc(void)

{

    CC_DST = T0 & T1;

}

/* operations without flags */

void OPPROTO op_addl_T0_T1(void)

{

    T0 += T1;

}

void OPPROTO op_orl_T0_T1(void)

{

    T0 |= T1;

}

void OPPROTO op_andl_T0_T1(void)

{

    T0 &= T1;

}

void OPPROTO op_subl_T0_T1(void)

{

    T0 -= T1;

}

void OPPROTO op_xorl_T0_T1(void)

{

    T0 ^= T1;

}

void OPPROTO op_negl_T0(void)

{

    T0 = -T0;

}

void OPPROTO op_incl_T0(void)

{

    T0++;

}

void OPPROTO op_decl_T0(void)

{

    T0--;

}

void OPPROTO op_notl_T0(void)

{

    T0 = ~T0;

}

void OPPROTO op_bswapl_T0(void)

{

    T0 = bswap32(T0);

}

/* multiply/divide */

void OPPROTO op_mulb_AL_T0(void)

{

    unsigned int res;

    res = (uint8_t)EAX * (uint8_t)T0;

    EAX = (EAX & 0xffff0000) | res;

    CC_SRC = (res & 0xff00);

}

void OPPROTO op_imulb_AL_T0(void)

{

    int res;

    res = (int8_t)EAX * (int8_t)T0;

    EAX = (EAX & 0xffff0000) | (res & 0xffff);

    CC_SRC = (res != (int8_t)res);

}

void OPPROTO op_mulw_AX_T0(void)

{

    unsigned int res;

    res = (uint16_t)EAX * (uint16_t)T0;

    EAX = (EAX & 0xffff0000) | (res & 0xffff);

    EDX = (EDX & 0xffff0000) | ((res >> 16) & 0xffff);

    CC_SRC = res >> 16;

}

void OPPROTO op_imulw_AX_T0(void)

{

    int res;

    res = (int16_t)EAX * (int16_t)T0;

    EAX = (EAX & 0xffff0000) | (res & 0xffff);

    EDX = (EDX & 0xffff0000) | ((res >> 16) & 0xffff);

    CC_SRC = (res != (int16_t)res);

}

void OPPROTO op_mull_EAX_T0(void)

{

    uint64_t res;

    res = (uint64_t)((uint32_t)EAX) * (uint64_t)((uint32_t)T0);

    EAX = res;

    EDX = res >> 32;

    CC_SRC = res >> 32;

}

void OPPROTO op_imull_EAX_T0(void)

{

    int64_t res;

    res = (int64_t)((int32_t)EAX) * (int64_t)((int32_t)T0);

    EAX = res;

    EDX = res >> 32;

    CC_SRC = (res != (int32_t)res);

}

void OPPROTO op_imulw_T0_T1(void)

{

    int res;

    res = (int16_t)T0 * (int16_t)T1;

    T0 = res;

    CC_SRC = (res != (int16_t)res);

}

void OPPROTO op_imull_T0_T1(void)

{

    int64_t res;

    res = (int64_t)((int32_t)T0) * (int64_t)((int32_t)T1);

    T0 = res;

    CC_SRC = (res != (int32_t)res);

}

/* division, flags are undefined */

/* XXX: add exceptions for overflow */

void OPPROTO op_divb_AL_T0(void)

{

    unsigned int num, den, q, r;

    num = (EAX & 0xffff);

    den = (T0 & 0xff);

    if (den == 0)

        raise_exception(EXCP00_DIVZ);

    q = (num / den) & 0xff;

    r = (num % den) & 0xff;

    EAX = (EAX & 0xffff0000) | (r << 8) | q;

}

void OPPROTO op_idivb_AL_T0(void)

{

    int num, den, q, r;

    num = (int16_t)EAX;

    den = (int8_t)T0;

    if (den == 0)

        raise_exception(EXCP00_DIVZ);

    q = (num / den) & 0xff;

    r = (num % den) & 0xff;

    EAX = (EAX & 0xffff0000) | (r << 8) | q;

}

void OPPROTO op_divw_AX_T0(void)

{

    unsigned int num, den, q, r;

    num = (EAX & 0xffff) | ((EDX & 0xffff) << 16);

    den = (T0 & 0xffff);

    if (den == 0)

        raise_exception(EXCP00_DIVZ);

    q = (num / den) & 0xffff;

    r = (num % den) & 0xffff;

    EAX = (EAX & 0xffff0000) | q;

    EDX = (EDX & 0xffff0000) | r;

}

void OPPROTO op_idivw_AX_T0(void)

{

    int num, den, q, r;

    num = (EAX & 0xffff) | ((EDX & 0xffff) << 16);

    den = (int16_t)T0;

    if (den == 0)

        raise_exception(EXCP00_DIVZ);

    q = (num / den) & 0xffff;

    r = (num % den) & 0xffff;

    EAX = (EAX & 0xffff0000) | q;

    EDX = (EDX & 0xffff0000) | r;

}

void OPPROTO op_divl_EAX_T0(void)

{

    unsigned int den, q, r;

    uint64_t num;

    num = EAX | ((uint64_t)EDX << 32);

    den = T0;

    if (den == 0)

        raise_exception(EXCP00_DIVZ);

    q = (num / den);

    r = (num % den);

    EAX = q;

    EDX = r;

}

void OPPROTO op_idivl_EAX_T0(void)

{

    int den, q, r;

    int64_t num;

    num = EAX | ((uint64_t)EDX << 32);

    den = T0;

    if (den == 0)

        raise_exception(EXCP00_DIVZ);

    q = (num / den);

    r = (num % den);

    EAX = q;

    EDX = r;

}

/* constant load & misc op */

void OPPROTO op_movl_T0_im(void)

{

    T0 = PARAM1;

}

void OPPROTO op_addl_T0_im(void)

{

    T0 += PARAM1;

}

void OPPROTO op_andl_T0_ffff(void)

{

    T0 = T0 & 0xffff;

}

void OPPROTO op_movl_T0_T1(void)

{

    T0 = T1;

}

void OPPROTO op_movl_T1_im(void)

{

    T1 = PARAM1;

}

void OPPROTO op_addl_T1_im(void)

{

    T1 += PARAM1;

}

void OPPROTO op_movl_T1_A0(void)

{

    T1 = A0;

}

void OPPROTO op_movl_A0_im(void)

{

    A0 = PARAM1;

}

void OPPROTO op_addl_A0_im(void)

{

    A0 += PARAM1;

}

void OPPROTO op_andl_A0_ffff(void)

{

    A0 = A0 & 0xffff;

}

/* memory access */

void OPPROTO op_ldub_T0_A0(void)

{

    T0 = ldub((uint8_t *)A0);

}

void OPPROTO op_ldsb_T0_A0(void)

{

    T0 = ldsb((int8_t *)A0);

}

void OPPROTO op_lduw_T0_A0(void)

{

    T0 = lduw((uint8_t *)A0);

}

void OPPROTO op_ldsw_T0_A0(void)

{

    T0 = ldsw((int8_t *)A0);

}

void OPPROTO op_ldl_T0_A0(void)

{

    T0 = ldl((uint8_t *)A0);

}

void OPPROTO op_ldub_T1_A0(void)

{

    T1 = ldub((uint8_t *)A0);

}

void OPPROTO op_ldsb_T1_A0(void)

{

    T1 = ldsb((int8_t *)A0);

}

void OPPROTO op_lduw_T1_A0(void)

{

    T1 = lduw((uint8_t *)A0);

}

void OPPROTO op_ldsw_T1_A0(void)

{

    T1 = ldsw((int8_t *)A0);

}

void OPPROTO op_ldl_T1_A0(void)

{

    T1 = ldl((uint8_t *)A0);

}

void OPPROTO op_stb_T0_A0(void)

{

    stb((uint8_t *)A0, T0);

}

void OPPROTO op_stw_T0_A0(void)

{

    stw((uint8_t *)A0, T0);

}

void OPPROTO op_stl_T0_A0(void)

{

    stl((uint8_t *)A0, T0);

}

/* used for bit operations */

void OPPROTO op_add_bitw_A0_T1(void)

{

    A0 += ((int32_t)T1 >> 4) << 1;

}

void OPPROTO op_add_bitl_A0_T1(void)

{

    A0 += ((int32_t)T1 >> 5) << 2;

}

/* indirect jump */

void OPPROTO op_jmp_T0(void)

{

    EIP = T0;

}

void OPPROTO op_jmp_im(void)

{

    EIP = PARAM1;

}

void OPPROTO op_int_im(void)

{

    EIP = PARAM1;

    raise_exception(EXCP0D_GPF);

}

void OPPROTO op_int3(void)

{

    EIP = PARAM1;

    raise_exception(EXCP03_INT3);

}

void OPPROTO op_into(void)

{

    int eflags;

    eflags = cc_table[CC_OP].compute_all();

    if (eflags & CC_O) {

        EIP = PARAM1;

        raise_exception(EXCP04_INTO);

    } else {

        EIP = PARAM2;

    }

}

/* string ops */

#define ldul ldl

#define SHIFT 0

#include "ops_template.h"

#undef SHIFT

#define SHIFT 1

#include "ops_template.h"

#undef SHIFT

#define SHIFT 2

#include "ops_template.h"

#undef SHIFT

/* sign extend */

void OPPROTO op_movsbl_T0_T0(void)

{

    T0 = (int8_t)T0;

}

void OPPROTO op_movzbl_T0_T0(void)

{

    T0 = (uint8_t)T0;

}

void OPPROTO op_movswl_T0_T0(void)

{

    T0 = (int16_t)T0;

}

void OPPROTO op_movzwl_T0_T0(void)

{

    T0 = (uint16_t)T0;

}

void OPPROTO op_movswl_EAX_AX(void)

{

    EAX = (int16_t)EAX;

}

void OPPROTO op_movsbw_AX_AL(void)

{

    EAX = (EAX & 0xffff0000) | ((int8_t)EAX & 0xffff);

}

void OPPROTO op_movslq_EDX_EAX(void)

{

    EDX = (int32_t)EAX >> 31;

}

void OPPROTO op_movswl_DX_AX(void)

{

    EDX = (EDX & 0xffff0000) | (((int16_t)EAX >> 15) & 0xffff);

}

/* push/pop */

void op_pushl_T0(void)

{

    uint32_t offset;

    offset = ESP - 4;

    stl((void *)offset, T0);

    /* modify ESP after to handle exceptions correctly */

    ESP = offset;

}

void op_pushw_T0(void)

{

    uint32_t offset;

    offset = ESP - 2;

    stw((void *)offset, T0);

    /* modify ESP after to handle exceptions correctly */

    ESP = offset;

}

void op_pushl_ss32_T0(void)

{

    uint32_t offset;

    offset = ESP - 4;

    stl(env->seg_cache[R_SS].base + offset, T0);

    /* modify ESP after to handle exceptions correctly */

    ESP = offset;

}

void op_pushw_ss32_T0(void)

{

    uint32_t offset;

    offset = ESP - 2;

    stw(env->seg_cache[R_SS].base + offset, T0);

    /* modify ESP after to handle exceptions correctly */

    ESP = offset;

}

void op_pushl_ss16_T0(void)

{

    uint32_t offset;

    offset = (ESP - 4) & 0xffff;

    stl(env->seg_cache[R_SS].base + offset, T0);

    /* modify ESP after to handle exceptions correctly */

    ESP = (ESP & ~0xffff) | offset;

}

void op_pushw_ss16_T0(void)

{

    uint32_t offset;

    offset = (ESP - 2) & 0xffff;

    stw(env->seg_cache[R_SS].base + offset, T0);

    /* modify ESP after to handle exceptions correctly */

    ESP = (ESP & ~0xffff) | offset;

}

/* NOTE: ESP update is done after */

void op_popl_T0(void)

{

    T0 = ldl((void *)ESP);

}

void op_popw_T0(void)

{

    T0 = lduw((void *)ESP);

}

void op_popl_ss32_T0(void)

{

    T0 = ldl(env->seg_cache[R_SS].base + ESP);

}

void op_popw_ss32_T0(void)

{

    T0 = lduw(env->seg_cache[R_SS].base + ESP);

}

void op_popl_ss16_T0(void)

{

    T0 = ldl(env->seg_cache[R_SS].base + (ESP & 0xffff));

}

void op_popw_ss16_T0(void)

{

    T0 = lduw(env->seg_cache[R_SS].base + (ESP & 0xffff));

}

void op_addl_ESP_4(void)

{

    ESP += 4;

}

void op_addl_ESP_2(void)

{

    ESP += 2;

}

void op_addw_ESP_4(void)

{

    ESP = (ESP & ~0xffff) | ((ESP + 4) & 0xffff);

}

void op_addw_ESP_2(void)

{

    ESP = (ESP & ~0xffff) | ((ESP + 2) & 0xffff);

}

void op_addl_ESP_im(void)

{

    ESP += PARAM1;

}

void op_addw_ESP_im(void)

{

    ESP = (ESP & ~0xffff) | ((ESP + PARAM1) & 0xffff);

}

/* rdtsc */

#ifndef __i386__

uint64_t emu_time;

#endif

void op_rdtsc(void)

{

    uint64_t val;

#ifdef __i386__

    asm("rdtsc" : "=A" (val));

#else

    /* better than nothing: the time increases */

    val = emu_time++;

#endif

    EAX = val;

    EDX = val >> 32;

}

/* bcd */

/* XXX: exception */

void OPPROTO op_aam(void)

{

    int base = PARAM1;

    int al, ah;

    al = EAX & 0xff;

    ah = al / base;

    al = al % base;

    EAX = (EAX & ~0xffff) | al | (ah << 8);

    CC_DST = al;

}

void OPPROTO op_aad(void)

{

    int base = PARAM1;

    int al, ah;

    al = EAX & 0xff;

    ah = (EAX >> 8) & 0xff;

    al = ((ah * base) + al) & 0xff;

    EAX = (EAX & ~0xffff) | al;

    CC_DST = al;

}

void OPPROTO op_aaa(void)

{

    int icarry;

    int al, ah, af;

    int eflags;

    eflags = cc_table[CC_OP].compute_all();

    af = eflags & CC_A;

    al = EAX & 0xff;

    ah = (EAX >> 8) & 0xff;

    icarry = (al > 0xf9);

    if (((al & 0x0f) > 9 ) || af) {

        al = (al + 6) & 0x0f;

        ah = (ah + 1 + icarry) & 0xff;

        eflags |= CC_C | CC_A;

    } else {

        eflags &= ~(CC_C | CC_A);

        al &= 0x0f;

    }

    EAX = (EAX & ~0xffff) | al | (ah << 8);

    CC_SRC = eflags;

}

void OPPROTO op_aas(void)

{

    int icarry;

    int al, ah, af;

    int eflags;

    eflags = cc_table[CC_OP].compute_all();

    af = eflags & CC_A;

    al = EAX & 0xff;

    ah = (EAX >> 8) & 0xff;

    icarry = (al < 6);

    if (((al & 0x0f) > 9 ) || af) {

        al = (al - 6) & 0x0f;

        ah = (ah - 1 - icarry) & 0xff;

        eflags |= CC_C | CC_A;

    } else {

        eflags &= ~(CC_C | CC_A);

        al &= 0x0f;

    }

    EAX = (EAX & ~0xffff) | al | (ah << 8);

    CC_SRC = eflags;

}

void OPPROTO op_daa(void)

{

    int al, af, cf;

    int eflags;

    eflags = cc_table[CC_OP].compute_all();

    cf = eflags & CC_C;

    af = eflags & CC_A;

    al = EAX & 0xff;

    eflags = 0;

    if (((al & 0x0f) > 9 ) || af) {