mirror of https://gitee.com/openkylin/qemu.git
472 lines
10 KiB
C
472 lines
10 KiB
C
/*
|
|
* x86 integer helpers
|
|
*
|
|
* 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, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "cpu.h"
|
|
#include "qemu/host-utils.h"
|
|
#include "helper.h"
|
|
|
|
//#define DEBUG_MULDIV
|
|
|
|
/* modulo 9 table */
|
|
static 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,
|
|
};
|
|
|
|
/* modulo 17 table */
|
|
static 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,
|
|
};
|
|
|
|
/* division, flags are undefined */
|
|
|
|
void helper_divb_AL(CPUX86State *env, target_ulong t0)
|
|
{
|
|
unsigned int num, den, q, r;
|
|
|
|
num = (env->regs[R_EAX] & 0xffff);
|
|
den = (t0 & 0xff);
|
|
if (den == 0) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q = (num / den);
|
|
if (q > 0xff) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q &= 0xff;
|
|
r = (num % den) & 0xff;
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | (r << 8) | q;
|
|
}
|
|
|
|
void helper_idivb_AL(CPUX86State *env, target_ulong t0)
|
|
{
|
|
int num, den, q, r;
|
|
|
|
num = (int16_t)env->regs[R_EAX];
|
|
den = (int8_t)t0;
|
|
if (den == 0) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q = (num / den);
|
|
if (q != (int8_t)q) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q &= 0xff;
|
|
r = (num % den) & 0xff;
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | (r << 8) | q;
|
|
}
|
|
|
|
void helper_divw_AX(CPUX86State *env, target_ulong t0)
|
|
{
|
|
unsigned int num, den, q, r;
|
|
|
|
num = (env->regs[R_EAX] & 0xffff) | ((env->regs[R_EDX] & 0xffff) << 16);
|
|
den = (t0 & 0xffff);
|
|
if (den == 0) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q = (num / den);
|
|
if (q > 0xffff) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q &= 0xffff;
|
|
r = (num % den) & 0xffff;
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | q;
|
|
env->regs[R_EDX] = (env->regs[R_EDX] & ~0xffff) | r;
|
|
}
|
|
|
|
void helper_idivw_AX(CPUX86State *env, target_ulong t0)
|
|
{
|
|
int num, den, q, r;
|
|
|
|
num = (env->regs[R_EAX] & 0xffff) | ((env->regs[R_EDX] & 0xffff) << 16);
|
|
den = (int16_t)t0;
|
|
if (den == 0) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q = (num / den);
|
|
if (q != (int16_t)q) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q &= 0xffff;
|
|
r = (num % den) & 0xffff;
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | q;
|
|
env->regs[R_EDX] = (env->regs[R_EDX] & ~0xffff) | r;
|
|
}
|
|
|
|
void helper_divl_EAX(CPUX86State *env, target_ulong t0)
|
|
{
|
|
unsigned int den, r;
|
|
uint64_t num, q;
|
|
|
|
num = ((uint32_t)env->regs[R_EAX]) | ((uint64_t)((uint32_t)env->regs[R_EDX]) << 32);
|
|
den = t0;
|
|
if (den == 0) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q = (num / den);
|
|
r = (num % den);
|
|
if (q > 0xffffffff) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
env->regs[R_EAX] = (uint32_t)q;
|
|
env->regs[R_EDX] = (uint32_t)r;
|
|
}
|
|
|
|
void helper_idivl_EAX(CPUX86State *env, target_ulong t0)
|
|
{
|
|
int den, r;
|
|
int64_t num, q;
|
|
|
|
num = ((uint32_t)env->regs[R_EAX]) | ((uint64_t)((uint32_t)env->regs[R_EDX]) << 32);
|
|
den = t0;
|
|
if (den == 0) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
q = (num / den);
|
|
r = (num % den);
|
|
if (q != (int32_t)q) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
env->regs[R_EAX] = (uint32_t)q;
|
|
env->regs[R_EDX] = (uint32_t)r;
|
|
}
|
|
|
|
/* bcd */
|
|
|
|
/* XXX: exception */
|
|
void helper_aam(CPUX86State *env, int base)
|
|
{
|
|
int al, ah;
|
|
|
|
al = env->regs[R_EAX] & 0xff;
|
|
ah = al / base;
|
|
al = al % base;
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | al | (ah << 8);
|
|
CC_DST = al;
|
|
}
|
|
|
|
void helper_aad(CPUX86State *env, int base)
|
|
{
|
|
int al, ah;
|
|
|
|
al = env->regs[R_EAX] & 0xff;
|
|
ah = (env->regs[R_EAX] >> 8) & 0xff;
|
|
al = ((ah * base) + al) & 0xff;
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | al;
|
|
CC_DST = al;
|
|
}
|
|
|
|
void helper_aaa(CPUX86State *env)
|
|
{
|
|
int icarry;
|
|
int al, ah, af;
|
|
int eflags;
|
|
|
|
eflags = cpu_cc_compute_all(env, CC_OP);
|
|
af = eflags & CC_A;
|
|
al = env->regs[R_EAX] & 0xff;
|
|
ah = (env->regs[R_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;
|
|
}
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | al | (ah << 8);
|
|
CC_SRC = eflags;
|
|
}
|
|
|
|
void helper_aas(CPUX86State *env)
|
|
{
|
|
int icarry;
|
|
int al, ah, af;
|
|
int eflags;
|
|
|
|
eflags = cpu_cc_compute_all(env, CC_OP);
|
|
af = eflags & CC_A;
|
|
al = env->regs[R_EAX] & 0xff;
|
|
ah = (env->regs[R_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;
|
|
}
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | al | (ah << 8);
|
|
CC_SRC = eflags;
|
|
}
|
|
|
|
void helper_daa(CPUX86State *env)
|
|
{
|
|
int old_al, al, af, cf;
|
|
int eflags;
|
|
|
|
eflags = cpu_cc_compute_all(env, CC_OP);
|
|
cf = eflags & CC_C;
|
|
af = eflags & CC_A;
|
|
old_al = al = env->regs[R_EAX] & 0xff;
|
|
|
|
eflags = 0;
|
|
if (((al & 0x0f) > 9) || af) {
|
|
al = (al + 6) & 0xff;
|
|
eflags |= CC_A;
|
|
}
|
|
if ((old_al > 0x99) || cf) {
|
|
al = (al + 0x60) & 0xff;
|
|
eflags |= CC_C;
|
|
}
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xff) | al;
|
|
/* well, speed is not an issue here, so we compute the flags by hand */
|
|
eflags |= (al == 0) << 6; /* zf */
|
|
eflags |= parity_table[al]; /* pf */
|
|
eflags |= (al & 0x80); /* sf */
|
|
CC_SRC = eflags;
|
|
}
|
|
|
|
void helper_das(CPUX86State *env)
|
|
{
|
|
int al, al1, af, cf;
|
|
int eflags;
|
|
|
|
eflags = cpu_cc_compute_all(env, CC_OP);
|
|
cf = eflags & CC_C;
|
|
af = eflags & CC_A;
|
|
al = env->regs[R_EAX] & 0xff;
|
|
|
|
eflags = 0;
|
|
al1 = al;
|
|
if (((al & 0x0f) > 9) || af) {
|
|
eflags |= CC_A;
|
|
if (al < 6 || cf) {
|
|
eflags |= CC_C;
|
|
}
|
|
al = (al - 6) & 0xff;
|
|
}
|
|
if ((al1 > 0x99) || cf) {
|
|
al = (al - 0x60) & 0xff;
|
|
eflags |= CC_C;
|
|
}
|
|
env->regs[R_EAX] = (env->regs[R_EAX] & ~0xff) | al;
|
|
/* well, speed is not an issue here, so we compute the flags by hand */
|
|
eflags |= (al == 0) << 6; /* zf */
|
|
eflags |= parity_table[al]; /* pf */
|
|
eflags |= (al & 0x80); /* sf */
|
|
CC_SRC = eflags;
|
|
}
|
|
|
|
#ifdef TARGET_X86_64
|
|
static void add128(uint64_t *plow, uint64_t *phigh, uint64_t a, uint64_t b)
|
|
{
|
|
*plow += a;
|
|
/* carry test */
|
|
if (*plow < a) {
|
|
(*phigh)++;
|
|
}
|
|
*phigh += b;
|
|
}
|
|
|
|
static void neg128(uint64_t *plow, uint64_t *phigh)
|
|
{
|
|
*plow = ~*plow;
|
|
*phigh = ~*phigh;
|
|
add128(plow, phigh, 1, 0);
|
|
}
|
|
|
|
/* return TRUE if overflow */
|
|
static int div64(uint64_t *plow, uint64_t *phigh, uint64_t b)
|
|
{
|
|
uint64_t q, r, a1, a0;
|
|
int i, qb, ab;
|
|
|
|
a0 = *plow;
|
|
a1 = *phigh;
|
|
if (a1 == 0) {
|
|
q = a0 / b;
|
|
r = a0 % b;
|
|
*plow = q;
|
|
*phigh = r;
|
|
} else {
|
|
if (a1 >= b) {
|
|
return 1;
|
|
}
|
|
/* XXX: use a better algorithm */
|
|
for (i = 0; i < 64; i++) {
|
|
ab = a1 >> 63;
|
|
a1 = (a1 << 1) | (a0 >> 63);
|
|
if (ab || a1 >= b) {
|
|
a1 -= b;
|
|
qb = 1;
|
|
} else {
|
|
qb = 0;
|
|
}
|
|
a0 = (a0 << 1) | qb;
|
|
}
|
|
#if defined(DEBUG_MULDIV)
|
|
printf("div: 0x%016" PRIx64 "%016" PRIx64 " / 0x%016" PRIx64
|
|
": q=0x%016" PRIx64 " r=0x%016" PRIx64 "\n",
|
|
*phigh, *plow, b, a0, a1);
|
|
#endif
|
|
*plow = a0;
|
|
*phigh = a1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* return TRUE if overflow */
|
|
static int idiv64(uint64_t *plow, uint64_t *phigh, int64_t b)
|
|
{
|
|
int sa, sb;
|
|
|
|
sa = ((int64_t)*phigh < 0);
|
|
if (sa) {
|
|
neg128(plow, phigh);
|
|
}
|
|
sb = (b < 0);
|
|
if (sb) {
|
|
b = -b;
|
|
}
|
|
if (div64(plow, phigh, b) != 0) {
|
|
return 1;
|
|
}
|
|
if (sa ^ sb) {
|
|
if (*plow > (1ULL << 63)) {
|
|
return 1;
|
|
}
|
|
*plow = -*plow;
|
|
} else {
|
|
if (*plow >= (1ULL << 63)) {
|
|
return 1;
|
|
}
|
|
}
|
|
if (sa) {
|
|
*phigh = -*phigh;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void helper_divq_EAX(CPUX86State *env, target_ulong t0)
|
|
{
|
|
uint64_t r0, r1;
|
|
|
|
if (t0 == 0) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
r0 = env->regs[R_EAX];
|
|
r1 = env->regs[R_EDX];
|
|
if (div64(&r0, &r1, t0)) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
env->regs[R_EAX] = r0;
|
|
env->regs[R_EDX] = r1;
|
|
}
|
|
|
|
void helper_idivq_EAX(CPUX86State *env, target_ulong t0)
|
|
{
|
|
uint64_t r0, r1;
|
|
|
|
if (t0 == 0) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
r0 = env->regs[R_EAX];
|
|
r1 = env->regs[R_EDX];
|
|
if (idiv64(&r0, &r1, t0)) {
|
|
raise_exception(env, EXCP00_DIVZ);
|
|
}
|
|
env->regs[R_EAX] = r0;
|
|
env->regs[R_EDX] = r1;
|
|
}
|
|
#endif
|
|
|
|
#if TARGET_LONG_BITS == 32
|
|
# define ctztl ctz32
|
|
# define clztl clz32
|
|
#else
|
|
# define ctztl ctz64
|
|
# define clztl clz64
|
|
#endif
|
|
|
|
/* bit operations */
|
|
target_ulong helper_ctz(target_ulong t0)
|
|
{
|
|
return ctztl(t0);
|
|
}
|
|
|
|
target_ulong helper_clz(target_ulong t0)
|
|
{
|
|
return clztl(t0);
|
|
}
|
|
|
|
target_ulong helper_pdep(target_ulong src, target_ulong mask)
|
|
{
|
|
target_ulong dest = 0;
|
|
int i, o;
|
|
|
|
for (i = 0; mask != 0; i++) {
|
|
o = ctztl(mask);
|
|
mask &= mask - 1;
|
|
dest |= ((src >> i) & 1) << o;
|
|
}
|
|
return dest;
|
|
}
|
|
|
|
target_ulong helper_pext(target_ulong src, target_ulong mask)
|
|
{
|
|
target_ulong dest = 0;
|
|
int i, o;
|
|
|
|
for (o = 0; mask != 0; o++) {
|
|
i = ctztl(mask);
|
|
mask &= mask - 1;
|
|
dest |= ((src >> i) & 1) << o;
|
|
}
|
|
return dest;
|
|
}
|
|
|
|
#define SHIFT 0
|
|
#include "shift_helper_template.h"
|
|
#undef SHIFT
|
|
|
|
#define SHIFT 1
|
|
#include "shift_helper_template.h"
|
|
#undef SHIFT
|
|
|
|
#define SHIFT 2
|
|
#include "shift_helper_template.h"
|
|
#undef SHIFT
|
|
|
|
#ifdef TARGET_X86_64
|
|
#define SHIFT 3
|
|
#include "shift_helper_template.h"
|
|
#undef SHIFT
|
|
#endif
|