pseries: Add spapr_rtc_read() helper function
[qemu/ar7.git] / target-i386 / int_helper.c
blobb0d78e6eeeda962a5d69cef6720260ebd362f5a7
1 /*
2 * x86 integer helpers
4 * Copyright (c) 2003 Fabrice Bellard
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
20 #include "cpu.h"
21 #include "qemu/host-utils.h"
22 #include "exec/helper-proto.h"
24 //#define DEBUG_MULDIV
26 /* modulo 9 table */
27 static const uint8_t rclb_table[32] = {
28 0, 1, 2, 3, 4, 5, 6, 7,
29 8, 0, 1, 2, 3, 4, 5, 6,
30 7, 8, 0, 1, 2, 3, 4, 5,
31 6, 7, 8, 0, 1, 2, 3, 4,
34 /* modulo 17 table */
35 static const uint8_t rclw_table[32] = {
36 0, 1, 2, 3, 4, 5, 6, 7,
37 8, 9, 10, 11, 12, 13, 14, 15,
38 16, 0, 1, 2, 3, 4, 5, 6,
39 7, 8, 9, 10, 11, 12, 13, 14,
42 /* division, flags are undefined */
44 void helper_divb_AL(CPUX86State *env, target_ulong t0)
46 unsigned int num, den, q, r;
48 num = (env->regs[R_EAX] & 0xffff);
49 den = (t0 & 0xff);
50 if (den == 0) {
51 raise_exception(env, EXCP00_DIVZ);
53 q = (num / den);
54 if (q > 0xff) {
55 raise_exception(env, EXCP00_DIVZ);
57 q &= 0xff;
58 r = (num % den) & 0xff;
59 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | (r << 8) | q;
62 void helper_idivb_AL(CPUX86State *env, target_ulong t0)
64 int num, den, q, r;
66 num = (int16_t)env->regs[R_EAX];
67 den = (int8_t)t0;
68 if (den == 0) {
69 raise_exception(env, EXCP00_DIVZ);
71 q = (num / den);
72 if (q != (int8_t)q) {
73 raise_exception(env, EXCP00_DIVZ);
75 q &= 0xff;
76 r = (num % den) & 0xff;
77 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | (r << 8) | q;
80 void helper_divw_AX(CPUX86State *env, target_ulong t0)
82 unsigned int num, den, q, r;
84 num = (env->regs[R_EAX] & 0xffff) | ((env->regs[R_EDX] & 0xffff) << 16);
85 den = (t0 & 0xffff);
86 if (den == 0) {
87 raise_exception(env, EXCP00_DIVZ);
89 q = (num / den);
90 if (q > 0xffff) {
91 raise_exception(env, EXCP00_DIVZ);
93 q &= 0xffff;
94 r = (num % den) & 0xffff;
95 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | q;
96 env->regs[R_EDX] = (env->regs[R_EDX] & ~0xffff) | r;
99 void helper_idivw_AX(CPUX86State *env, target_ulong t0)
101 int num, den, q, r;
103 num = (env->regs[R_EAX] & 0xffff) | ((env->regs[R_EDX] & 0xffff) << 16);
104 den = (int16_t)t0;
105 if (den == 0) {
106 raise_exception(env, EXCP00_DIVZ);
108 q = (num / den);
109 if (q != (int16_t)q) {
110 raise_exception(env, EXCP00_DIVZ);
112 q &= 0xffff;
113 r = (num % den) & 0xffff;
114 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | q;
115 env->regs[R_EDX] = (env->regs[R_EDX] & ~0xffff) | r;
118 void helper_divl_EAX(CPUX86State *env, target_ulong t0)
120 unsigned int den, r;
121 uint64_t num, q;
123 num = ((uint32_t)env->regs[R_EAX]) | ((uint64_t)((uint32_t)env->regs[R_EDX]) << 32);
124 den = t0;
125 if (den == 0) {
126 raise_exception(env, EXCP00_DIVZ);
128 q = (num / den);
129 r = (num % den);
130 if (q > 0xffffffff) {
131 raise_exception(env, EXCP00_DIVZ);
133 env->regs[R_EAX] = (uint32_t)q;
134 env->regs[R_EDX] = (uint32_t)r;
137 void helper_idivl_EAX(CPUX86State *env, target_ulong t0)
139 int den, r;
140 int64_t num, q;
142 num = ((uint32_t)env->regs[R_EAX]) | ((uint64_t)((uint32_t)env->regs[R_EDX]) << 32);
143 den = t0;
144 if (den == 0) {
145 raise_exception(env, EXCP00_DIVZ);
147 q = (num / den);
148 r = (num % den);
149 if (q != (int32_t)q) {
150 raise_exception(env, EXCP00_DIVZ);
152 env->regs[R_EAX] = (uint32_t)q;
153 env->regs[R_EDX] = (uint32_t)r;
156 /* bcd */
158 /* XXX: exception */
159 void helper_aam(CPUX86State *env, int base)
161 int al, ah;
163 al = env->regs[R_EAX] & 0xff;
164 ah = al / base;
165 al = al % base;
166 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | al | (ah << 8);
167 CC_DST = al;
170 void helper_aad(CPUX86State *env, int base)
172 int al, ah;
174 al = env->regs[R_EAX] & 0xff;
175 ah = (env->regs[R_EAX] >> 8) & 0xff;
176 al = ((ah * base) + al) & 0xff;
177 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | al;
178 CC_DST = al;
181 void helper_aaa(CPUX86State *env)
183 int icarry;
184 int al, ah, af;
185 int eflags;
187 eflags = cpu_cc_compute_all(env, CC_OP);
188 af = eflags & CC_A;
189 al = env->regs[R_EAX] & 0xff;
190 ah = (env->regs[R_EAX] >> 8) & 0xff;
192 icarry = (al > 0xf9);
193 if (((al & 0x0f) > 9) || af) {
194 al = (al + 6) & 0x0f;
195 ah = (ah + 1 + icarry) & 0xff;
196 eflags |= CC_C | CC_A;
197 } else {
198 eflags &= ~(CC_C | CC_A);
199 al &= 0x0f;
201 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | al | (ah << 8);
202 CC_SRC = eflags;
205 void helper_aas(CPUX86State *env)
207 int icarry;
208 int al, ah, af;
209 int eflags;
211 eflags = cpu_cc_compute_all(env, CC_OP);
212 af = eflags & CC_A;
213 al = env->regs[R_EAX] & 0xff;
214 ah = (env->regs[R_EAX] >> 8) & 0xff;
216 icarry = (al < 6);
217 if (((al & 0x0f) > 9) || af) {
218 al = (al - 6) & 0x0f;
219 ah = (ah - 1 - icarry) & 0xff;
220 eflags |= CC_C | CC_A;
221 } else {
222 eflags &= ~(CC_C | CC_A);
223 al &= 0x0f;
225 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xffff) | al | (ah << 8);
226 CC_SRC = eflags;
229 void helper_daa(CPUX86State *env)
231 int old_al, al, af, cf;
232 int eflags;
234 eflags = cpu_cc_compute_all(env, CC_OP);
235 cf = eflags & CC_C;
236 af = eflags & CC_A;
237 old_al = al = env->regs[R_EAX] & 0xff;
239 eflags = 0;
240 if (((al & 0x0f) > 9) || af) {
241 al = (al + 6) & 0xff;
242 eflags |= CC_A;
244 if ((old_al > 0x99) || cf) {
245 al = (al + 0x60) & 0xff;
246 eflags |= CC_C;
248 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xff) | al;
249 /* well, speed is not an issue here, so we compute the flags by hand */
250 eflags |= (al == 0) << 6; /* zf */
251 eflags |= parity_table[al]; /* pf */
252 eflags |= (al & 0x80); /* sf */
253 CC_SRC = eflags;
256 void helper_das(CPUX86State *env)
258 int al, al1, af, cf;
259 int eflags;
261 eflags = cpu_cc_compute_all(env, CC_OP);
262 cf = eflags & CC_C;
263 af = eflags & CC_A;
264 al = env->regs[R_EAX] & 0xff;
266 eflags = 0;
267 al1 = al;
268 if (((al & 0x0f) > 9) || af) {
269 eflags |= CC_A;
270 if (al < 6 || cf) {
271 eflags |= CC_C;
273 al = (al - 6) & 0xff;
275 if ((al1 > 0x99) || cf) {
276 al = (al - 0x60) & 0xff;
277 eflags |= CC_C;
279 env->regs[R_EAX] = (env->regs[R_EAX] & ~0xff) | al;
280 /* well, speed is not an issue here, so we compute the flags by hand */
281 eflags |= (al == 0) << 6; /* zf */
282 eflags |= parity_table[al]; /* pf */
283 eflags |= (al & 0x80); /* sf */
284 CC_SRC = eflags;
287 #ifdef TARGET_X86_64
288 static void add128(uint64_t *plow, uint64_t *phigh, uint64_t a, uint64_t b)
290 *plow += a;
291 /* carry test */
292 if (*plow < a) {
293 (*phigh)++;
295 *phigh += b;
298 static void neg128(uint64_t *plow, uint64_t *phigh)
300 *plow = ~*plow;
301 *phigh = ~*phigh;
302 add128(plow, phigh, 1, 0);
305 /* return TRUE if overflow */
306 static int div64(uint64_t *plow, uint64_t *phigh, uint64_t b)
308 uint64_t q, r, a1, a0;
309 int i, qb, ab;
311 a0 = *plow;
312 a1 = *phigh;
313 if (a1 == 0) {
314 q = a0 / b;
315 r = a0 % b;
316 *plow = q;
317 *phigh = r;
318 } else {
319 if (a1 >= b) {
320 return 1;
322 /* XXX: use a better algorithm */
323 for (i = 0; i < 64; i++) {
324 ab = a1 >> 63;
325 a1 = (a1 << 1) | (a0 >> 63);
326 if (ab || a1 >= b) {
327 a1 -= b;
328 qb = 1;
329 } else {
330 qb = 0;
332 a0 = (a0 << 1) | qb;
334 #if defined(DEBUG_MULDIV)
335 printf("div: 0x%016" PRIx64 "%016" PRIx64 " / 0x%016" PRIx64
336 ": q=0x%016" PRIx64 " r=0x%016" PRIx64 "\n",
337 *phigh, *plow, b, a0, a1);
338 #endif
339 *plow = a0;
340 *phigh = a1;
342 return 0;
345 /* return TRUE if overflow */
346 static int idiv64(uint64_t *plow, uint64_t *phigh, int64_t b)
348 int sa, sb;
350 sa = ((int64_t)*phigh < 0);
351 if (sa) {
352 neg128(plow, phigh);
354 sb = (b < 0);
355 if (sb) {
356 b = -b;
358 if (div64(plow, phigh, b) != 0) {
359 return 1;
361 if (sa ^ sb) {
362 if (*plow > (1ULL << 63)) {
363 return 1;
365 *plow = -*plow;
366 } else {
367 if (*plow >= (1ULL << 63)) {
368 return 1;
371 if (sa) {
372 *phigh = -*phigh;
374 return 0;
377 void helper_divq_EAX(CPUX86State *env, target_ulong t0)
379 uint64_t r0, r1;
381 if (t0 == 0) {
382 raise_exception(env, EXCP00_DIVZ);
384 r0 = env->regs[R_EAX];
385 r1 = env->regs[R_EDX];
386 if (div64(&r0, &r1, t0)) {
387 raise_exception(env, EXCP00_DIVZ);
389 env->regs[R_EAX] = r0;
390 env->regs[R_EDX] = r1;
393 void helper_idivq_EAX(CPUX86State *env, target_ulong t0)
395 uint64_t r0, r1;
397 if (t0 == 0) {
398 raise_exception(env, EXCP00_DIVZ);
400 r0 = env->regs[R_EAX];
401 r1 = env->regs[R_EDX];
402 if (idiv64(&r0, &r1, t0)) {
403 raise_exception(env, EXCP00_DIVZ);
405 env->regs[R_EAX] = r0;
406 env->regs[R_EDX] = r1;
408 #endif
410 #if TARGET_LONG_BITS == 32
411 # define ctztl ctz32
412 # define clztl clz32
413 #else
414 # define ctztl ctz64
415 # define clztl clz64
416 #endif
418 /* bit operations */
419 target_ulong helper_ctz(target_ulong t0)
421 return ctztl(t0);
424 target_ulong helper_clz(target_ulong t0)
426 return clztl(t0);
429 target_ulong helper_pdep(target_ulong src, target_ulong mask)
431 target_ulong dest = 0;
432 int i, o;
434 for (i = 0; mask != 0; i++) {
435 o = ctztl(mask);
436 mask &= mask - 1;
437 dest |= ((src >> i) & 1) << o;
439 return dest;
442 target_ulong helper_pext(target_ulong src, target_ulong mask)
444 target_ulong dest = 0;
445 int i, o;
447 for (o = 0; mask != 0; o++) {
448 i = ctztl(mask);
449 mask &= mask - 1;
450 dest |= ((src >> i) & 1) << o;
452 return dest;
455 #define SHIFT 0
456 #include "shift_helper_template.h"
457 #undef SHIFT
459 #define SHIFT 1
460 #include "shift_helper_template.h"
461 #undef SHIFT
463 #define SHIFT 2
464 #include "shift_helper_template.h"
465 #undef SHIFT
467 #ifdef TARGET_X86_64
468 #define SHIFT 3
469 #include "shift_helper_template.h"
470 #undef SHIFT
471 #endif