root / target-ppc / op.c @ afc7df11
History | View | Annotate | Download (20.2 kB)
1 |
/*
|
---|---|
2 |
* PPC emulation micro-operations for qemu.
|
3 |
*
|
4 |
* Copyright (c) 2003 Jocelyn Mayer
|
5 |
*
|
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.
|
10 |
*
|
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.
|
15 |
*
|
16 |
* You should have received a copy of the GNU Lesser General Public
|
17 |
* License along with this library; if not, write to the Free Software
|
18 |
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
19 |
*/
|
20 |
|
21 |
//#define DEBUG_OP
|
22 |
|
23 |
#include "config.h" |
24 |
#include "exec.h" |
25 |
|
26 |
#define regs (env)
|
27 |
#define Ts0 (int32_t)T0
|
28 |
#define Ts1 (int32_t)T1
|
29 |
#define Ts2 (int32_t)T2
|
30 |
|
31 |
#define FT0 (env->ft0)
|
32 |
#define FT1 (env->ft1)
|
33 |
#define FT2 (env->ft2)
|
34 |
|
35 |
#define FTS0 ((float)env->ft0) |
36 |
#define FTS1 ((float)env->ft1) |
37 |
#define FTS2 ((float)env->ft2) |
38 |
|
39 |
#define PPC_OP(name) void glue(op_, name)(void) |
40 |
|
41 |
#define REG 0 |
42 |
#include "op_template.h" |
43 |
|
44 |
#define REG 1 |
45 |
#include "op_template.h" |
46 |
|
47 |
#define REG 2 |
48 |
#include "op_template.h" |
49 |
|
50 |
#define REG 3 |
51 |
#include "op_template.h" |
52 |
|
53 |
#define REG 4 |
54 |
#include "op_template.h" |
55 |
|
56 |
#define REG 5 |
57 |
#include "op_template.h" |
58 |
|
59 |
#define REG 6 |
60 |
#include "op_template.h" |
61 |
|
62 |
#define REG 7 |
63 |
#include "op_template.h" |
64 |
|
65 |
#define REG 8 |
66 |
#include "op_template.h" |
67 |
|
68 |
#define REG 9 |
69 |
#include "op_template.h" |
70 |
|
71 |
#define REG 10 |
72 |
#include "op_template.h" |
73 |
|
74 |
#define REG 11 |
75 |
#include "op_template.h" |
76 |
|
77 |
#define REG 12 |
78 |
#include "op_template.h" |
79 |
|
80 |
#define REG 13 |
81 |
#include "op_template.h" |
82 |
|
83 |
#define REG 14 |
84 |
#include "op_template.h" |
85 |
|
86 |
#define REG 15 |
87 |
#include "op_template.h" |
88 |
|
89 |
#define REG 16 |
90 |
#include "op_template.h" |
91 |
|
92 |
#define REG 17 |
93 |
#include "op_template.h" |
94 |
|
95 |
#define REG 18 |
96 |
#include "op_template.h" |
97 |
|
98 |
#define REG 19 |
99 |
#include "op_template.h" |
100 |
|
101 |
#define REG 20 |
102 |
#include "op_template.h" |
103 |
|
104 |
#define REG 21 |
105 |
#include "op_template.h" |
106 |
|
107 |
#define REG 22 |
108 |
#include "op_template.h" |
109 |
|
110 |
#define REG 23 |
111 |
#include "op_template.h" |
112 |
|
113 |
#define REG 24 |
114 |
#include "op_template.h" |
115 |
|
116 |
#define REG 25 |
117 |
#include "op_template.h" |
118 |
|
119 |
#define REG 26 |
120 |
#include "op_template.h" |
121 |
|
122 |
#define REG 27 |
123 |
#include "op_template.h" |
124 |
|
125 |
#define REG 28 |
126 |
#include "op_template.h" |
127 |
|
128 |
#define REG 29 |
129 |
#include "op_template.h" |
130 |
|
131 |
#define REG 30 |
132 |
#include "op_template.h" |
133 |
|
134 |
#define REG 31 |
135 |
#include "op_template.h" |
136 |
|
137 |
/* PPC state maintenance operations */
|
138 |
/* set_Rc0 */
|
139 |
PPC_OP(set_Rc0) |
140 |
{ |
141 |
uint32_t tmp; |
142 |
|
143 |
if (Ts0 < 0) { |
144 |
tmp = 0x08;
|
145 |
} else if (Ts0 > 0) { |
146 |
tmp = 0x04;
|
147 |
} else {
|
148 |
tmp = 0x02;
|
149 |
} |
150 |
tmp |= xer_ov; |
151 |
env->crf[0] = tmp;
|
152 |
RETURN(); |
153 |
} |
154 |
|
155 |
/* reset_Rc0 */
|
156 |
PPC_OP(reset_Rc0) |
157 |
{ |
158 |
env->crf[0] = 0x02 | xer_ov; |
159 |
RETURN(); |
160 |
} |
161 |
|
162 |
/* set_Rc0_1 */
|
163 |
PPC_OP(set_Rc0_1) |
164 |
{ |
165 |
env->crf[0] = 0x04 | xer_ov; |
166 |
RETURN(); |
167 |
} |
168 |
|
169 |
/* Set Rc1 (for floating point arithmetic) */
|
170 |
PPC_OP(set_Rc1) |
171 |
{ |
172 |
env->crf[1] = regs->fpscr[7]; |
173 |
RETURN(); |
174 |
} |
175 |
|
176 |
/* Constants load */
|
177 |
PPC_OP(set_T0) |
178 |
{ |
179 |
T0 = PARAM(1);
|
180 |
RETURN(); |
181 |
} |
182 |
|
183 |
PPC_OP(set_T1) |
184 |
{ |
185 |
T1 = PARAM(1);
|
186 |
RETURN(); |
187 |
} |
188 |
|
189 |
PPC_OP(set_T2) |
190 |
{ |
191 |
T2 = PARAM(1);
|
192 |
RETURN(); |
193 |
} |
194 |
|
195 |
/* Generate exceptions */
|
196 |
PPC_OP(raise_exception_err) |
197 |
{ |
198 |
do_raise_exception_err(PARAM(1), PARAM(2)); |
199 |
} |
200 |
|
201 |
PPC_OP(raise_exception) |
202 |
{ |
203 |
do_raise_exception(PARAM(1));
|
204 |
} |
205 |
|
206 |
PPC_OP(update_nip) |
207 |
{ |
208 |
env->nip = PARAM(1);
|
209 |
} |
210 |
|
211 |
PPC_OP(debug) |
212 |
{ |
213 |
env->nip = PARAM(1);
|
214 |
#if defined (DEBUG_OP)
|
215 |
dump_state(); |
216 |
#endif
|
217 |
do_raise_exception(EXCP_DEBUG); |
218 |
RETURN(); |
219 |
} |
220 |
|
221 |
/* Segment registers load and store with immediate index */
|
222 |
PPC_OP(load_srin) |
223 |
{ |
224 |
T0 = regs->sr[T1 >> 28];
|
225 |
RETURN(); |
226 |
} |
227 |
|
228 |
PPC_OP(store_srin) |
229 |
{ |
230 |
do_store_sr(T1 >> 28);
|
231 |
RETURN(); |
232 |
} |
233 |
|
234 |
PPC_OP(load_sdr1) |
235 |
{ |
236 |
T0 = regs->sdr1; |
237 |
RETURN(); |
238 |
} |
239 |
|
240 |
PPC_OP(store_sdr1) |
241 |
{ |
242 |
regs->sdr1 = T0; |
243 |
RETURN(); |
244 |
} |
245 |
|
246 |
PPC_OP(exit_tb) |
247 |
{ |
248 |
EXIT_TB(); |
249 |
} |
250 |
|
251 |
/* Load/store special registers */
|
252 |
PPC_OP(load_cr) |
253 |
{ |
254 |
do_load_cr(); |
255 |
RETURN(); |
256 |
} |
257 |
|
258 |
PPC_OP(store_cr) |
259 |
{ |
260 |
do_store_cr(PARAM(1));
|
261 |
RETURN(); |
262 |
} |
263 |
|
264 |
PPC_OP(load_xer_cr) |
265 |
{ |
266 |
T0 = (xer_so << 3) | (xer_ov << 2) | (xer_ca << 1); |
267 |
RETURN(); |
268 |
} |
269 |
|
270 |
PPC_OP(clear_xer_cr) |
271 |
{ |
272 |
xer_so = 0;
|
273 |
xer_ov = 0;
|
274 |
xer_ca = 0;
|
275 |
RETURN(); |
276 |
} |
277 |
|
278 |
PPC_OP(load_xer_bc) |
279 |
{ |
280 |
T1 = xer_bc; |
281 |
RETURN(); |
282 |
} |
283 |
|
284 |
PPC_OP(load_xer) |
285 |
{ |
286 |
do_load_xer(); |
287 |
RETURN(); |
288 |
} |
289 |
|
290 |
PPC_OP(store_xer) |
291 |
{ |
292 |
do_store_xer(); |
293 |
RETURN(); |
294 |
} |
295 |
|
296 |
PPC_OP(load_msr) |
297 |
{ |
298 |
do_load_msr(); |
299 |
RETURN(); |
300 |
} |
301 |
|
302 |
PPC_OP(store_msr) |
303 |
{ |
304 |
do_store_msr(); |
305 |
RETURN(); |
306 |
} |
307 |
|
308 |
/* SPR */
|
309 |
PPC_OP(load_spr) |
310 |
{ |
311 |
T0 = regs->spr[PARAM(1)];
|
312 |
RETURN(); |
313 |
} |
314 |
|
315 |
PPC_OP(store_spr) |
316 |
{ |
317 |
regs->spr[PARAM(1)] = T0;
|
318 |
RETURN(); |
319 |
} |
320 |
|
321 |
PPC_OP(load_lr) |
322 |
{ |
323 |
T0 = regs->lr; |
324 |
RETURN(); |
325 |
} |
326 |
|
327 |
PPC_OP(store_lr) |
328 |
{ |
329 |
regs->lr = T0; |
330 |
RETURN(); |
331 |
} |
332 |
|
333 |
PPC_OP(load_ctr) |
334 |
{ |
335 |
T0 = regs->ctr; |
336 |
RETURN(); |
337 |
} |
338 |
|
339 |
PPC_OP(store_ctr) |
340 |
{ |
341 |
regs->ctr = T0; |
342 |
RETURN(); |
343 |
} |
344 |
|
345 |
PPC_OP(load_tbl) |
346 |
{ |
347 |
T0 = cpu_ppc_load_tbl(regs); |
348 |
RETURN(); |
349 |
} |
350 |
|
351 |
PPC_OP(load_tbu) |
352 |
{ |
353 |
T0 = cpu_ppc_load_tbu(regs); |
354 |
RETURN(); |
355 |
} |
356 |
|
357 |
PPC_OP(store_tbl) |
358 |
{ |
359 |
cpu_ppc_store_tbl(regs, T0); |
360 |
RETURN(); |
361 |
} |
362 |
|
363 |
PPC_OP(store_tbu) |
364 |
{ |
365 |
cpu_ppc_store_tbu(regs, T0); |
366 |
RETURN(); |
367 |
} |
368 |
|
369 |
PPC_OP(load_decr) |
370 |
{ |
371 |
T0 = cpu_ppc_load_decr(regs); |
372 |
} |
373 |
|
374 |
PPC_OP(store_decr) |
375 |
{ |
376 |
cpu_ppc_store_decr(regs, T0); |
377 |
RETURN(); |
378 |
} |
379 |
|
380 |
PPC_OP(load_ibat) |
381 |
{ |
382 |
T0 = regs->IBAT[PARAM(1)][PARAM(2)]; |
383 |
} |
384 |
|
385 |
PPC_OP(store_ibat) |
386 |
{ |
387 |
do_store_ibat(PARAM(1), PARAM(2)); |
388 |
} |
389 |
|
390 |
PPC_OP(load_dbat) |
391 |
{ |
392 |
T0 = regs->DBAT[PARAM(1)][PARAM(2)]; |
393 |
} |
394 |
|
395 |
PPC_OP(store_dbat) |
396 |
{ |
397 |
do_store_dbat(PARAM(1), PARAM(2)); |
398 |
} |
399 |
|
400 |
/* FPSCR */
|
401 |
PPC_OP(load_fpscr) |
402 |
{ |
403 |
do_load_fpscr(); |
404 |
RETURN(); |
405 |
} |
406 |
|
407 |
PPC_OP(store_fpscr) |
408 |
{ |
409 |
do_store_fpscr(PARAM(1));
|
410 |
RETURN(); |
411 |
} |
412 |
|
413 |
PPC_OP(reset_scrfx) |
414 |
{ |
415 |
regs->fpscr[7] &= ~0x8; |
416 |
RETURN(); |
417 |
} |
418 |
|
419 |
/* crf operations */
|
420 |
PPC_OP(getbit_T0) |
421 |
{ |
422 |
T0 = (T0 >> PARAM(1)) & 1; |
423 |
RETURN(); |
424 |
} |
425 |
|
426 |
PPC_OP(getbit_T1) |
427 |
{ |
428 |
T1 = (T1 >> PARAM(1)) & 1; |
429 |
RETURN(); |
430 |
} |
431 |
|
432 |
PPC_OP(setcrfbit) |
433 |
{ |
434 |
T1 = (T1 & PARAM(1)) | (T0 << PARAM(2)); |
435 |
RETURN(); |
436 |
} |
437 |
|
438 |
/* Branch */
|
439 |
#define EIP regs->nip
|
440 |
|
441 |
PPC_OP(setlr) |
442 |
{ |
443 |
regs->lr = PARAM1; |
444 |
} |
445 |
|
446 |
PPC_OP(b) |
447 |
{ |
448 |
JUMP_TB(b1, PARAM1, 0, PARAM2);
|
449 |
} |
450 |
|
451 |
PPC_OP(b_T1) |
452 |
{ |
453 |
regs->nip = T1; |
454 |
} |
455 |
|
456 |
PPC_OP(btest) |
457 |
{ |
458 |
if (T0) {
|
459 |
JUMP_TB(btest, PARAM1, 0, PARAM2);
|
460 |
} else {
|
461 |
JUMP_TB(btest, PARAM1, 1, PARAM3);
|
462 |
} |
463 |
RETURN(); |
464 |
} |
465 |
|
466 |
PPC_OP(btest_T1) |
467 |
{ |
468 |
if (T0) {
|
469 |
regs->nip = T1 & ~3;
|
470 |
} else {
|
471 |
regs->nip = PARAM1; |
472 |
} |
473 |
RETURN(); |
474 |
} |
475 |
|
476 |
PPC_OP(movl_T1_ctr) |
477 |
{ |
478 |
T1 = regs->ctr; |
479 |
} |
480 |
|
481 |
PPC_OP(movl_T1_lr) |
482 |
{ |
483 |
T1 = regs->lr; |
484 |
} |
485 |
|
486 |
/* tests with result in T0 */
|
487 |
|
488 |
PPC_OP(test_ctr) |
489 |
{ |
490 |
T0 = regs->ctr; |
491 |
} |
492 |
|
493 |
PPC_OP(test_ctr_true) |
494 |
{ |
495 |
T0 = (regs->ctr != 0 && (T0 & PARAM(1)) != 0); |
496 |
} |
497 |
|
498 |
PPC_OP(test_ctr_false) |
499 |
{ |
500 |
T0 = (regs->ctr != 0 && (T0 & PARAM(1)) == 0); |
501 |
} |
502 |
|
503 |
PPC_OP(test_ctrz) |
504 |
{ |
505 |
T0 = (regs->ctr == 0);
|
506 |
} |
507 |
|
508 |
PPC_OP(test_ctrz_true) |
509 |
{ |
510 |
T0 = (regs->ctr == 0 && (T0 & PARAM(1)) != 0); |
511 |
} |
512 |
|
513 |
PPC_OP(test_ctrz_false) |
514 |
{ |
515 |
T0 = (regs->ctr == 0 && (T0 & PARAM(1)) == 0); |
516 |
} |
517 |
|
518 |
PPC_OP(test_true) |
519 |
{ |
520 |
T0 = (T0 & PARAM(1));
|
521 |
} |
522 |
|
523 |
PPC_OP(test_false) |
524 |
{ |
525 |
T0 = ((T0 & PARAM(1)) == 0); |
526 |
} |
527 |
|
528 |
/* CTR maintenance */
|
529 |
PPC_OP(dec_ctr) |
530 |
{ |
531 |
regs->ctr--; |
532 |
RETURN(); |
533 |
} |
534 |
|
535 |
/*** Integer arithmetic ***/
|
536 |
/* add */
|
537 |
PPC_OP(add) |
538 |
{ |
539 |
T0 += T1; |
540 |
RETURN(); |
541 |
} |
542 |
|
543 |
PPC_OP(addo) |
544 |
{ |
545 |
T2 = T0; |
546 |
T0 += T1; |
547 |
if ((T2 ^ T1 ^ (-1)) & (T2 ^ T0) & (1 << 31)) { |
548 |
xer_so = 1;
|
549 |
xer_ov = 1;
|
550 |
} else {
|
551 |
xer_ov = 0;
|
552 |
} |
553 |
RETURN(); |
554 |
} |
555 |
|
556 |
/* add carrying */
|
557 |
PPC_OP(addc) |
558 |
{ |
559 |
T2 = T0; |
560 |
T0 += T1; |
561 |
if (T0 < T2) {
|
562 |
xer_ca = 1;
|
563 |
} else {
|
564 |
xer_ca = 0;
|
565 |
} |
566 |
RETURN(); |
567 |
} |
568 |
|
569 |
PPC_OP(addco) |
570 |
{ |
571 |
T2 = T0; |
572 |
T0 += T1; |
573 |
if (T0 < T2) {
|
574 |
xer_ca = 1;
|
575 |
} else {
|
576 |
xer_ca = 0;
|
577 |
} |
578 |
if ((T2 ^ T1 ^ (-1)) & (T2 ^ T0) & (1 << 31)) { |
579 |
xer_so = 1;
|
580 |
xer_ov = 1;
|
581 |
} else {
|
582 |
xer_ov = 0;
|
583 |
} |
584 |
RETURN(); |
585 |
} |
586 |
|
587 |
/* add extended */
|
588 |
/* candidate for helper (too long) */
|
589 |
PPC_OP(adde) |
590 |
{ |
591 |
T2 = T0; |
592 |
T0 += T1 + xer_ca; |
593 |
if (T0 < T2 || (xer_ca == 1 && T0 == T2)) { |
594 |
xer_ca = 1;
|
595 |
} else {
|
596 |
xer_ca = 0;
|
597 |
} |
598 |
RETURN(); |
599 |
} |
600 |
|
601 |
PPC_OP(addeo) |
602 |
{ |
603 |
T2 = T0; |
604 |
T0 += T1 + xer_ca; |
605 |
if (T0 < T2 || (xer_ca == 1 && T0 == T2)) { |
606 |
xer_ca = 1;
|
607 |
} else {
|
608 |
xer_ca = 0;
|
609 |
} |
610 |
if ((T2 ^ T1 ^ (-1)) & (T2 ^ T0) & (1 << 31)) { |
611 |
xer_so = 1;
|
612 |
xer_ov = 1;
|
613 |
} else {
|
614 |
xer_ov = 0;
|
615 |
} |
616 |
RETURN(); |
617 |
} |
618 |
|
619 |
/* add immediate */
|
620 |
PPC_OP(addi) |
621 |
{ |
622 |
T0 += PARAM(1);
|
623 |
RETURN(); |
624 |
} |
625 |
|
626 |
/* add immediate carrying */
|
627 |
PPC_OP(addic) |
628 |
{ |
629 |
T1 = T0; |
630 |
T0 += PARAM(1);
|
631 |
if (T0 < T1) {
|
632 |
xer_ca = 1;
|
633 |
} else {
|
634 |
xer_ca = 0;
|
635 |
} |
636 |
RETURN(); |
637 |
} |
638 |
|
639 |
/* add to minus one extended */
|
640 |
PPC_OP(addme) |
641 |
{ |
642 |
T1 = T0; |
643 |
T0 += xer_ca + (-1);
|
644 |
if (T1 != 0) |
645 |
xer_ca = 1;
|
646 |
RETURN(); |
647 |
} |
648 |
|
649 |
PPC_OP(addmeo) |
650 |
{ |
651 |
T1 = T0; |
652 |
T0 += xer_ca + (-1);
|
653 |
if (T1 & (T1 ^ T0) & (1 << 31)) { |
654 |
xer_so = 1;
|
655 |
xer_ov = 1;
|
656 |
} else {
|
657 |
xer_ov = 0;
|
658 |
} |
659 |
if (T1 != 0) |
660 |
xer_ca = 1;
|
661 |
RETURN(); |
662 |
} |
663 |
|
664 |
/* add to zero extended */
|
665 |
PPC_OP(addze) |
666 |
{ |
667 |
T1 = T0; |
668 |
T0 += xer_ca; |
669 |
if (T0 < T1) {
|
670 |
xer_ca = 1;
|
671 |
} else {
|
672 |
xer_ca = 0;
|
673 |
} |
674 |
RETURN(); |
675 |
} |
676 |
|
677 |
PPC_OP(addzeo) |
678 |
{ |
679 |
T1 = T0; |
680 |
T0 += xer_ca; |
681 |
if ((T1 ^ (-1)) & (T1 ^ T0) & (1 << 31)) { |
682 |
xer_so = 1;
|
683 |
xer_ov = 1;
|
684 |
} else {
|
685 |
xer_ov = 0;
|
686 |
} |
687 |
if (T0 < T1) {
|
688 |
xer_ca = 1;
|
689 |
} else {
|
690 |
xer_ca = 0;
|
691 |
} |
692 |
RETURN(); |
693 |
} |
694 |
|
695 |
/* divide word */
|
696 |
/* candidate for helper (too long) */
|
697 |
PPC_OP(divw) |
698 |
{ |
699 |
if ((Ts0 == INT32_MIN && Ts1 == -1) || Ts1 == 0) { |
700 |
T0 = (int32_t)((-1) * (T0 >> 31)); |
701 |
} else {
|
702 |
T0 = (Ts0 / Ts1); |
703 |
} |
704 |
RETURN(); |
705 |
} |
706 |
|
707 |
PPC_OP(divwo) |
708 |
{ |
709 |
if ((Ts0 == INT32_MIN && Ts1 == -1) || Ts1 == 0) { |
710 |
xer_so = 1;
|
711 |
xer_ov = 1;
|
712 |
T0 = (-1) * (T0 >> 31); |
713 |
} else {
|
714 |
xer_ov = 0;
|
715 |
T0 = (Ts0 / Ts1); |
716 |
} |
717 |
RETURN(); |
718 |
} |
719 |
|
720 |
/* divide word unsigned */
|
721 |
PPC_OP(divwu) |
722 |
{ |
723 |
if (T1 == 0) { |
724 |
T0 = 0;
|
725 |
} else {
|
726 |
T0 /= T1; |
727 |
} |
728 |
RETURN(); |
729 |
} |
730 |
|
731 |
PPC_OP(divwuo) |
732 |
{ |
733 |
if (T1 == 0) { |
734 |
xer_so = 1;
|
735 |
xer_ov = 1;
|
736 |
T0 = 0;
|
737 |
} else {
|
738 |
xer_ov = 0;
|
739 |
T0 /= T1; |
740 |
} |
741 |
RETURN(); |
742 |
} |
743 |
|
744 |
/* multiply high word */
|
745 |
PPC_OP(mulhw) |
746 |
{ |
747 |
T0 = ((int64_t)Ts0 * (int64_t)Ts1) >> 32;
|
748 |
RETURN(); |
749 |
} |
750 |
|
751 |
/* multiply high word unsigned */
|
752 |
PPC_OP(mulhwu) |
753 |
{ |
754 |
T0 = ((uint64_t)T0 * (uint64_t)T1) >> 32;
|
755 |
RETURN(); |
756 |
} |
757 |
|
758 |
/* multiply low immediate */
|
759 |
PPC_OP(mulli) |
760 |
{ |
761 |
T0 = (Ts0 * SPARAM(1));
|
762 |
RETURN(); |
763 |
} |
764 |
|
765 |
/* multiply low word */
|
766 |
PPC_OP(mullw) |
767 |
{ |
768 |
T0 *= T1; |
769 |
RETURN(); |
770 |
} |
771 |
|
772 |
PPC_OP(mullwo) |
773 |
{ |
774 |
int64_t res = (int64_t)Ts0 * (int64_t)Ts1; |
775 |
|
776 |
if ((int32_t)res != res) {
|
777 |
xer_ov = 1;
|
778 |
xer_so = 1;
|
779 |
} else {
|
780 |
xer_ov = 0;
|
781 |
} |
782 |
T0 = (int32_t)res; |
783 |
RETURN(); |
784 |
} |
785 |
|
786 |
/* negate */
|
787 |
PPC_OP(neg) |
788 |
{ |
789 |
if (T0 != 0x80000000) { |
790 |
T0 = -Ts0; |
791 |
} |
792 |
RETURN(); |
793 |
} |
794 |
|
795 |
PPC_OP(nego) |
796 |
{ |
797 |
if (T0 == 0x80000000) { |
798 |
xer_ov = 1;
|
799 |
xer_so = 1;
|
800 |
} else {
|
801 |
xer_ov = 0;
|
802 |
T0 = -Ts0; |
803 |
} |
804 |
RETURN(); |
805 |
} |
806 |
|
807 |
/* substract from */
|
808 |
PPC_OP(subf) |
809 |
{ |
810 |
T0 = T1 - T0; |
811 |
RETURN(); |
812 |
} |
813 |
|
814 |
PPC_OP(subfo) |
815 |
{ |
816 |
T2 = T0; |
817 |
T0 = T1 - T0; |
818 |
if (((~T2) ^ T1 ^ (-1)) & ((~T2) ^ T0) & (1 << 31)) { |
819 |
xer_so = 1;
|
820 |
xer_ov = 1;
|
821 |
} else {
|
822 |
xer_ov = 0;
|
823 |
} |
824 |
RETURN(); |
825 |
} |
826 |
|
827 |
/* substract from carrying */
|
828 |
PPC_OP(subfc) |
829 |
{ |
830 |
T0 = T1 - T0; |
831 |
if (T0 <= T1) {
|
832 |
xer_ca = 1;
|
833 |
} else {
|
834 |
xer_ca = 0;
|
835 |
} |
836 |
RETURN(); |
837 |
} |
838 |
|
839 |
PPC_OP(subfco) |
840 |
{ |
841 |
T2 = T0; |
842 |
T0 = T1 - T0; |
843 |
if (T0 <= T1) {
|
844 |
xer_ca = 1;
|
845 |
} else {
|
846 |
xer_ca = 0;
|
847 |
} |
848 |
if (((~T2) ^ T1 ^ (-1)) & ((~T2) ^ T0) & (1 << 31)) { |
849 |
xer_so = 1;
|
850 |
xer_ov = 1;
|
851 |
} else {
|
852 |
xer_ov = 0;
|
853 |
} |
854 |
RETURN(); |
855 |
} |
856 |
|
857 |
/* substract from extended */
|
858 |
/* candidate for helper (too long) */
|
859 |
PPC_OP(subfe) |
860 |
{ |
861 |
T0 = T1 + ~T0 + xer_ca; |
862 |
if (T0 < T1 || (xer_ca == 1 && T0 == T1)) { |
863 |
xer_ca = 1;
|
864 |
} else {
|
865 |
xer_ca = 0;
|
866 |
} |
867 |
RETURN(); |
868 |
} |
869 |
|
870 |
PPC_OP(subfeo) |
871 |
{ |
872 |
T2 = T0; |
873 |
T0 = T1 + ~T0 + xer_ca; |
874 |
if ((~T2 ^ T1 ^ (-1)) & (~T2 ^ T0) & (1 << 31)) { |
875 |
xer_so = 1;
|
876 |
xer_ov = 1;
|
877 |
} else {
|
878 |
xer_ov = 0;
|
879 |
} |
880 |
if (T0 < T1 || (xer_ca == 1 && T0 == T1)) { |
881 |
xer_ca = 1;
|
882 |
} else {
|
883 |
xer_ca = 0;
|
884 |
} |
885 |
RETURN(); |
886 |
} |
887 |
|
888 |
/* substract from immediate carrying */
|
889 |
PPC_OP(subfic) |
890 |
{ |
891 |
T0 = PARAM(1) + ~T0 + 1; |
892 |
if (T0 <= PARAM(1)) { |
893 |
xer_ca = 1;
|
894 |
} else {
|
895 |
xer_ca = 0;
|
896 |
} |
897 |
RETURN(); |
898 |
} |
899 |
|
900 |
/* substract from minus one extended */
|
901 |
PPC_OP(subfme) |
902 |
{ |
903 |
T0 = ~T0 + xer_ca - 1;
|
904 |
|
905 |
if (T0 != -1) |
906 |
xer_ca = 1;
|
907 |
RETURN(); |
908 |
} |
909 |
|
910 |
PPC_OP(subfmeo) |
911 |
{ |
912 |
T1 = T0; |
913 |
T0 = ~T0 + xer_ca - 1;
|
914 |
if (~T1 & (~T1 ^ T0) & (1 << 31)) { |
915 |
xer_so = 1;
|
916 |
xer_ov = 1;
|
917 |
} else {
|
918 |
xer_ov = 0;
|
919 |
} |
920 |
if (T1 != -1) |
921 |
xer_ca = 1;
|
922 |
RETURN(); |
923 |
} |
924 |
|
925 |
/* substract from zero extended */
|
926 |
PPC_OP(subfze) |
927 |
{ |
928 |
T1 = ~T0; |
929 |
T0 = T1 + xer_ca; |
930 |
if (T0 < T1) {
|
931 |
xer_ca = 1;
|
932 |
} else {
|
933 |
xer_ca = 0;
|
934 |
} |
935 |
RETURN(); |
936 |
} |
937 |
|
938 |
PPC_OP(subfzeo) |
939 |
{ |
940 |
T1 = T0; |
941 |
T0 = ~T0 + xer_ca; |
942 |
if ((~T1 ^ (-1)) & ((~T1) ^ T0) & (1 << 31)) { |
943 |
xer_ov = 1;
|
944 |
xer_so = 1;
|
945 |
} else {
|
946 |
xer_ov = 0;
|
947 |
} |
948 |
if (T0 < ~T1) {
|
949 |
xer_ca = 1;
|
950 |
} else {
|
951 |
xer_ca = 0;
|
952 |
} |
953 |
RETURN(); |
954 |
} |
955 |
|
956 |
/*** Integer comparison ***/
|
957 |
/* compare */
|
958 |
PPC_OP(cmp) |
959 |
{ |
960 |
if (Ts0 < Ts1) {
|
961 |
T0 = 0x08;
|
962 |
} else if (Ts0 > Ts1) { |
963 |
T0 = 0x04;
|
964 |
} else {
|
965 |
T0 = 0x02;
|
966 |
} |
967 |
RETURN(); |
968 |
} |
969 |
|
970 |
/* compare immediate */
|
971 |
PPC_OP(cmpi) |
972 |
{ |
973 |
if (Ts0 < SPARAM(1)) { |
974 |
T0 = 0x08;
|
975 |
} else if (Ts0 > SPARAM(1)) { |
976 |
T0 = 0x04;
|
977 |
} else {
|
978 |
T0 = 0x02;
|
979 |
} |
980 |
RETURN(); |
981 |
} |
982 |
|
983 |
/* compare logical */
|
984 |
PPC_OP(cmpl) |
985 |
{ |
986 |
if (T0 < T1) {
|
987 |
T0 = 0x08;
|
988 |
} else if (T0 > T1) { |
989 |
T0 = 0x04;
|
990 |
} else {
|
991 |
T0 = 0x02;
|
992 |
} |
993 |
RETURN(); |
994 |
} |
995 |
|
996 |
/* compare logical immediate */
|
997 |
PPC_OP(cmpli) |
998 |
{ |
999 |
if (T0 < PARAM(1)) { |
1000 |
T0 = 0x08;
|
1001 |
} else if (T0 > PARAM(1)) { |
1002 |
T0 = 0x04;
|
1003 |
} else {
|
1004 |
T0 = 0x02;
|
1005 |
} |
1006 |
RETURN(); |
1007 |
} |
1008 |
|
1009 |
/*** Integer logical ***/
|
1010 |
/* and */
|
1011 |
PPC_OP(and) |
1012 |
{ |
1013 |
T0 &= T1; |
1014 |
RETURN(); |
1015 |
} |
1016 |
|
1017 |
/* andc */
|
1018 |
PPC_OP(andc) |
1019 |
{ |
1020 |
T0 &= ~T1; |
1021 |
RETURN(); |
1022 |
} |
1023 |
|
1024 |
/* andi. */
|
1025 |
PPC_OP(andi_) |
1026 |
{ |
1027 |
T0 &= PARAM(1);
|
1028 |
RETURN(); |
1029 |
} |
1030 |
|
1031 |
/* count leading zero */
|
1032 |
PPC_OP(cntlzw) |
1033 |
{ |
1034 |
T1 = T0; |
1035 |
for (T0 = 32; T1 > 0; T0--) |
1036 |
T1 = T1 >> 1;
|
1037 |
RETURN(); |
1038 |
} |
1039 |
|
1040 |
/* eqv */
|
1041 |
PPC_OP(eqv) |
1042 |
{ |
1043 |
T0 = ~(T0 ^ T1); |
1044 |
RETURN(); |
1045 |
} |
1046 |
|
1047 |
/* extend sign byte */
|
1048 |
PPC_OP(extsb) |
1049 |
{ |
1050 |
T0 = (int32_t)((int8_t)(Ts0)); |
1051 |
RETURN(); |
1052 |
} |
1053 |
|
1054 |
/* extend sign half word */
|
1055 |
PPC_OP(extsh) |
1056 |
{ |
1057 |
T0 = (int32_t)((int16_t)(Ts0)); |
1058 |
RETURN(); |
1059 |
} |
1060 |
|
1061 |
/* nand */
|
1062 |
PPC_OP(nand) |
1063 |
{ |
1064 |
T0 = ~(T0 & T1); |
1065 |
RETURN(); |
1066 |
} |
1067 |
|
1068 |
/* nor */
|
1069 |
PPC_OP(nor) |
1070 |
{ |
1071 |
T0 = ~(T0 | T1); |
1072 |
RETURN(); |
1073 |
} |
1074 |
|
1075 |
/* or */
|
1076 |
PPC_OP(or) |
1077 |
{ |
1078 |
T0 |= T1; |
1079 |
RETURN(); |
1080 |
} |
1081 |
|
1082 |
/* orc */
|
1083 |
PPC_OP(orc) |
1084 |
{ |
1085 |
T0 |= ~T1; |
1086 |
RETURN(); |
1087 |
} |
1088 |
|
1089 |
/* ori */
|
1090 |
PPC_OP(ori) |
1091 |
{ |
1092 |
T0 |= PARAM(1);
|
1093 |
RETURN(); |
1094 |
} |
1095 |
|
1096 |
/* xor */
|
1097 |
PPC_OP(xor) |
1098 |
{ |
1099 |
T0 ^= T1; |
1100 |
RETURN(); |
1101 |
} |
1102 |
|
1103 |
/* xori */
|
1104 |
PPC_OP(xori) |
1105 |
{ |
1106 |
T0 ^= PARAM(1);
|
1107 |
RETURN(); |
1108 |
} |
1109 |
|
1110 |
/*** Integer rotate ***/
|
1111 |
/* rotate left word immediate then mask insert */
|
1112 |
PPC_OP(rlwimi) |
1113 |
{ |
1114 |
T0 = (rotl(T0, PARAM(1)) & PARAM(2)) | (T1 & PARAM(3)); |
1115 |
RETURN(); |
1116 |
} |
1117 |
|
1118 |
/* rotate left immediate then and with mask insert */
|
1119 |
PPC_OP(rotlwi) |
1120 |
{ |
1121 |
T0 = rotl(T0, PARAM(1));
|
1122 |
RETURN(); |
1123 |
} |
1124 |
|
1125 |
PPC_OP(slwi) |
1126 |
{ |
1127 |
T0 = T0 << PARAM(1);
|
1128 |
RETURN(); |
1129 |
} |
1130 |
|
1131 |
PPC_OP(srwi) |
1132 |
{ |
1133 |
T0 = T0 >> PARAM(1);
|
1134 |
RETURN(); |
1135 |
} |
1136 |
|
1137 |
/* rotate left word then and with mask insert */
|
1138 |
PPC_OP(rlwinm) |
1139 |
{ |
1140 |
T0 = rotl(T0, PARAM(1)) & PARAM(2); |
1141 |
RETURN(); |
1142 |
} |
1143 |
|
1144 |
PPC_OP(rotl) |
1145 |
{ |
1146 |
T0 = rotl(T0, T1); |
1147 |
RETURN(); |
1148 |
} |
1149 |
|
1150 |
PPC_OP(rlwnm) |
1151 |
{ |
1152 |
T0 = rotl(T0, T1) & PARAM(1);
|
1153 |
RETURN(); |
1154 |
} |
1155 |
|
1156 |
/*** Integer shift ***/
|
1157 |
/* shift left word */
|
1158 |
PPC_OP(slw) |
1159 |
{ |
1160 |
if (T1 & 0x20) { |
1161 |
T0 = 0;
|
1162 |
} else {
|
1163 |
T0 = T0 << T1; |
1164 |
} |
1165 |
RETURN(); |
1166 |
} |
1167 |
|
1168 |
/* shift right algebraic word */
|
1169 |
PPC_OP(sraw) |
1170 |
{ |
1171 |
do_sraw(); |
1172 |
RETURN(); |
1173 |
} |
1174 |
|
1175 |
/* shift right algebraic word immediate */
|
1176 |
PPC_OP(srawi) |
1177 |
{ |
1178 |
T1 = T0; |
1179 |
T0 = (Ts0 >> PARAM(1));
|
1180 |
if (Ts1 < 0 && (Ts1 & PARAM(2)) != 0) { |
1181 |
xer_ca = 1;
|
1182 |
} else {
|
1183 |
xer_ca = 0;
|
1184 |
} |
1185 |
RETURN(); |
1186 |
} |
1187 |
|
1188 |
/* shift right word */
|
1189 |
PPC_OP(srw) |
1190 |
{ |
1191 |
if (T1 & 0x20) { |
1192 |
T0 = 0;
|
1193 |
} else {
|
1194 |
T0 = T0 >> T1; |
1195 |
} |
1196 |
RETURN(); |
1197 |
} |
1198 |
|
1199 |
/*** Floating-Point arithmetic ***/
|
1200 |
/* fadd - fadd. */
|
1201 |
PPC_OP(fadd) |
1202 |
{ |
1203 |
FT0 += FT1; |
1204 |
RETURN(); |
1205 |
} |
1206 |
|
1207 |
/* fadds - fadds. */
|
1208 |
PPC_OP(fadds) |
1209 |
{ |
1210 |
FT0 = FTS0 + FTS1; |
1211 |
RETURN(); |
1212 |
} |
1213 |
|
1214 |
/* fsub - fsub. */
|
1215 |
PPC_OP(fsub) |
1216 |
{ |
1217 |
FT0 -= FT1; |
1218 |
RETURN(); |
1219 |
} |
1220 |
|
1221 |
/* fsubs - fsubs. */
|
1222 |
PPC_OP(fsubs) |
1223 |
{ |
1224 |
FT0 = FTS0 - FTS1; |
1225 |
RETURN(); |
1226 |
} |
1227 |
|
1228 |
/* fmul - fmul. */
|
1229 |
PPC_OP(fmul) |
1230 |
{ |
1231 |
FT0 *= FT1; |
1232 |
RETURN(); |
1233 |
} |
1234 |
|
1235 |
/* fmuls - fmuls. */
|
1236 |
PPC_OP(fmuls) |
1237 |
{ |
1238 |
FT0 = FTS0 * FTS1; |
1239 |
RETURN(); |
1240 |
} |
1241 |
|
1242 |
/* fdiv - fdiv. */
|
1243 |
PPC_OP(fdiv) |
1244 |
{ |
1245 |
FT0 /= FT1; |
1246 |
RETURN(); |
1247 |
} |
1248 |
|
1249 |
/* fdivs - fdivs. */
|
1250 |
PPC_OP(fdivs) |
1251 |
{ |
1252 |
FT0 = FTS0 / FTS1; |
1253 |
RETURN(); |
1254 |
} |
1255 |
|
1256 |
/* fsqrt - fsqrt. */
|
1257 |
PPC_OP(fsqrt) |
1258 |
{ |
1259 |
do_fsqrt(); |
1260 |
RETURN(); |
1261 |
} |
1262 |
|
1263 |
/* fsqrts - fsqrts. */
|
1264 |
PPC_OP(fsqrts) |
1265 |
{ |
1266 |
do_fsqrts(); |
1267 |
RETURN(); |
1268 |
} |
1269 |
|
1270 |
/* fres - fres. */
|
1271 |
PPC_OP(fres) |
1272 |
{ |
1273 |
do_fres(); |
1274 |
RETURN(); |
1275 |
} |
1276 |
|
1277 |
/* frsqrte - frsqrte. */
|
1278 |
PPC_OP(frsqrte) |
1279 |
{ |
1280 |
do_fsqrte(); |
1281 |
RETURN(); |
1282 |
} |
1283 |
|
1284 |
/* fsel - fsel. */
|
1285 |
PPC_OP(fsel) |
1286 |
{ |
1287 |
do_fsel(); |
1288 |
RETURN(); |
1289 |
} |
1290 |
|
1291 |
/*** Floating-Point multiply-and-add ***/
|
1292 |
/* fmadd - fmadd. */
|
1293 |
PPC_OP(fmadd) |
1294 |
{ |
1295 |
FT0 = (FT0 * FT1) + FT2; |
1296 |
RETURN(); |
1297 |
} |
1298 |
|
1299 |
/* fmadds - fmadds. */
|
1300 |
PPC_OP(fmadds) |
1301 |
{ |
1302 |
FT0 = (FTS0 * FTS1) + FTS2; |
1303 |
RETURN(); |
1304 |
} |
1305 |
|
1306 |
/* fmsub - fmsub. */
|
1307 |
PPC_OP(fmsub) |
1308 |
{ |
1309 |
FT0 = (FT0 * FT1) - FT2; |
1310 |
RETURN(); |
1311 |
} |
1312 |
|
1313 |
/* fmsubs - fmsubs. */
|
1314 |
PPC_OP(fmsubs) |
1315 |
{ |
1316 |
FT0 = (FTS0 * FTS1) - FTS2; |
1317 |
RETURN(); |
1318 |
} |
1319 |
|
1320 |
/* fnmadd - fnmadd. - fnmadds - fnmadds. */
|
1321 |
PPC_OP(fnmadd) |
1322 |
{ |
1323 |
do_fnmadd(); |
1324 |
RETURN(); |
1325 |
} |
1326 |
|
1327 |
/* fnmadds - fnmadds. */
|
1328 |
PPC_OP(fnmadds) |
1329 |
{ |
1330 |
do_fnmadds(); |
1331 |
RETURN(); |
1332 |
} |
1333 |
|
1334 |
/* fnmsub - fnmsub. */
|
1335 |
PPC_OP(fnmsub) |
1336 |
{ |
1337 |
do_fnmsub(); |
1338 |
RETURN(); |
1339 |
} |
1340 |
|
1341 |
/* fnmsubs - fnmsubs. */
|
1342 |
PPC_OP(fnmsubs) |
1343 |
{ |
1344 |
do_fnmsubs(); |
1345 |
RETURN(); |
1346 |
} |
1347 |
|
1348 |
/*** Floating-Point round & convert ***/
|
1349 |
/* frsp - frsp. */
|
1350 |
PPC_OP(frsp) |
1351 |
{ |
1352 |
FT0 = (float)FT0;
|
1353 |
RETURN(); |
1354 |
} |
1355 |
|
1356 |
/* fctiw - fctiw. */
|
1357 |
PPC_OP(fctiw) |
1358 |
{ |
1359 |
do_fctiw(); |
1360 |
RETURN(); |
1361 |
} |
1362 |
|
1363 |
/* fctiwz - fctiwz. */
|
1364 |
PPC_OP(fctiwz) |
1365 |
{ |
1366 |
do_fctiwz(); |
1367 |
RETURN(); |
1368 |
} |
1369 |
|
1370 |
|
1371 |
/*** Floating-Point compare ***/
|
1372 |
/* fcmpu */
|
1373 |
PPC_OP(fcmpu) |
1374 |
{ |
1375 |
do_fcmpu(); |
1376 |
RETURN(); |
1377 |
} |
1378 |
|
1379 |
/* fcmpo */
|
1380 |
PPC_OP(fcmpo) |
1381 |
{ |
1382 |
do_fcmpo(); |
1383 |
RETURN(); |
1384 |
} |
1385 |
|
1386 |
/*** Floating-point move ***/
|
1387 |
/* fabs */
|
1388 |
PPC_OP(fabs) |
1389 |
{ |
1390 |
do_fabs(); |
1391 |
RETURN(); |
1392 |
} |
1393 |
|
1394 |
/* fnabs */
|
1395 |
PPC_OP(fnabs) |
1396 |
{ |
1397 |
do_fnabs(); |
1398 |
RETURN(); |
1399 |
} |
1400 |
|
1401 |
/* fneg */
|
1402 |
PPC_OP(fneg) |
1403 |
{ |
1404 |
FT0 = -FT0; |
1405 |
RETURN(); |
1406 |
} |
1407 |
|
1408 |
/* Load and store */
|
1409 |
#define MEMSUFFIX _raw
|
1410 |
#include "op_mem.h" |
1411 |
#if !defined(CONFIG_USER_ONLY)
|
1412 |
#define MEMSUFFIX _user
|
1413 |
#include "op_mem.h" |
1414 |
|
1415 |
#define MEMSUFFIX _kernel
|
1416 |
#include "op_mem.h" |
1417 |
#endif
|
1418 |
|
1419 |
/* Special op to check and maybe clear reservation */
|
1420 |
PPC_OP(check_reservation) |
1421 |
{ |
1422 |
do_check_reservation(); |
1423 |
RETURN(); |
1424 |
} |
1425 |
|
1426 |
/* Return from interrupt */
|
1427 |
PPC_OP(rfi) |
1428 |
{ |
1429 |
regs->nip = regs->spr[SRR0] & ~0x00000003;
|
1430 |
#if 1 // TRY |
1431 |
T0 = regs->spr[SRR1] & ~0xFFF00000;
|
1432 |
#else
|
1433 |
T0 = regs->spr[SRR1] & ~0xFFFF0000;
|
1434 |
#endif
|
1435 |
do_store_msr(); |
1436 |
#if defined (DEBUG_OP)
|
1437 |
dump_rfi(); |
1438 |
#endif
|
1439 |
// do_tlbia();
|
1440 |
do_raise_exception(EXCP_RFI); |
1441 |
RETURN(); |
1442 |
} |
1443 |
|
1444 |
/* Trap word */
|
1445 |
PPC_OP(tw) |
1446 |
{ |
1447 |
if ((Ts0 < Ts1 && (PARAM(1) & 0x10)) || |
1448 |
(Ts0 > Ts1 && (PARAM(1) & 0x08)) || |
1449 |
(Ts0 == Ts1 && (PARAM(1) & 0x04)) || |
1450 |
(T0 < T1 && (PARAM(1) & 0x02)) || |
1451 |
(T0 > T1 && (PARAM(1) & 0x01))) |
1452 |
do_raise_exception_err(EXCP_PROGRAM, EXCP_TRAP); |
1453 |
RETURN(); |
1454 |
} |
1455 |
|
1456 |
PPC_OP(twi) |
1457 |
{ |
1458 |
if ((Ts0 < SPARAM(1) && (PARAM(2) & 0x10)) || |
1459 |
(Ts0 > SPARAM(1) && (PARAM(2) & 0x08)) || |
1460 |
(Ts0 == SPARAM(1) && (PARAM(2) & 0x04)) || |
1461 |
(T0 < (uint32_t)SPARAM(1) && (PARAM(2) & 0x02)) || |
1462 |
(T0 > (uint32_t)SPARAM(1) && (PARAM(2) & 0x01))) |
1463 |
do_raise_exception_err(EXCP_PROGRAM, EXCP_TRAP); |
1464 |
RETURN(); |
1465 |
} |
1466 |
|
1467 |
/* Instruction cache block invalidate */
|
1468 |
PPC_OP(icbi) |
1469 |
{ |
1470 |
do_icbi(); |
1471 |
RETURN(); |
1472 |
} |
1473 |
|
1474 |
/* tlbia */
|
1475 |
PPC_OP(tlbia) |
1476 |
{ |
1477 |
do_tlbia(); |
1478 |
RETURN(); |
1479 |
} |
1480 |
|
1481 |
/* tlbie */
|
1482 |
PPC_OP(tlbie) |
1483 |
{ |
1484 |
do_tlbie(); |
1485 |
RETURN(); |
1486 |
} |