 00f5e6f21e
			
		
	
	
		00f5e6f21e
		
	
	
	
	
		
			
			Signed-off-by: liguang <lig.fnst@cn.fujitsu.com> Reviewed-by: Andreas Färber <afaerber@suse.de> Reviewed-by: Richard Henderson <rth@twiddle.net> Signed-off-by: Blue Swirl <blauwirbel@gmail.com>
		
			
				
	
	
		
			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
 |