3 // Simulator definition for the MIPS DSP ASE.
4 // Copyright (C) 2005 Free Software Foundation, Inc.
5 // Contributed by MIPS Technologies, Inc. Written by Chao-ying Fu.
7 // This file is part of GDB, the GNU debugger.
9 // This program is free software; you can redistribute it and/or modify
10 // it under the terms of the GNU General Public License as published by
11 // the Free Software Foundation; either version 2, or (at your option)
14 // This program is distributed in the hope that it will be useful,
15 // but WITHOUT ANY WARRANTY; without even the implied warranty of
16 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 // GNU General Public License for more details.
19 // You should have received a copy of the GNU General Public License along
20 // with this program; if not, write to the Free Software Foundation, Inc.,
21 // 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
24 // op: 0 = ADD, 1 = SUB
25 // sat: 0 = no saturation, 1 = saturation
26 :function:::void:do_ph_op:int rd, int rs, int rt, int op, int sat
31 unsigned32 v1 = GPR[rs];
32 unsigned32 v2 = GPR[rt];
33 unsigned32 result = 0;
34 for (i = 0; i < 32; i += 16, v1 >>= 16, v2 >>= 16)
36 h1 = (signed16)(v1 & 0xffff);
37 h2 = (signed16)(v2 & 0xffff);
39 h0 = (signed32)h1 + (signed32)h2;
41 h0 = (signed32)h1 - (signed32)h2;
42 if (((h0 & 0x10000) >> 1) != (h0 & 0x8000))
44 DSPCR |= DSPCR_OUFLAG4;
53 result |= ((unsigned32)((unsigned16)h0) << i);
55 GPR[rd] = EXTEND32 (result);
58 // op: 0 = ADD, 1 = SUB
59 :function:::void:do_w_op:int rd, int rs, int rt, int op
63 unsigned32 v1 = GPR[rs];
64 unsigned32 v2 = GPR[rt];
65 unsigned32 result = 0;
69 h0 = (signed64)h1 + (signed64)h2;
71 h0 = (signed64)h1 - (signed64)h2;
72 if (((h0 & 0x100000000) >> 1) != (h0 & 0x80000000))
74 DSPCR |= DSPCR_OUFLAG4;
80 GPR[rd] = EXTEND32 (h0);
83 // op: 0 = ADD, 1 = SUB
84 // sat: 0 = no saturation, 1 = saturation
85 :function:::void:do_qb_op:int rd, int rs, int rt, int op, int sat
90 unsigned32 v1 = GPR[rs];
91 unsigned32 v2 = GPR[rt];
92 unsigned32 result = 0;
93 for (i = 0; i < 32; i += 8, v1 >>= 8, v2 >>= 8)
95 h1 = (unsigned8)(v1 & 0xff);
96 h2 = (unsigned8)(v2 & 0xff);
98 h0 = (unsigned32)h1 + (unsigned32)h2;
100 h0 = (unsigned32)h1 - (unsigned32)h2;
103 DSPCR |= DSPCR_OUFLAG4;
112 result |= ((unsigned32)((unsigned8)h0) << i);
114 GPR[rd] = EXTEND32 (result);
117 // op: 0 = left, 1 = right
118 :function:::void:do_qb_shift:int rd, int rt, int shift, int op
122 unsigned32 v1 = GPR[rt];
123 unsigned32 result = 0;
124 for (i = 0; i < 32; i += 8, v1 >>= 8)
126 h0 = (unsigned8)(v1 & 0xff);
129 for (j = 7; j >= 8 - shift; j--)
133 DSPCR |= DSPCR_OUFLAG6;
141 result |= ((unsigned32)h0 << i);
143 GPR[rd] = EXTEND32 (result);
146 // op: 0 = left, 1 = right
147 // sat: 0 = no saturation/rounding, 1 = saturation/rounding
148 :function:::void:do_ph_shift:int rd, int rt, int shift, int op, int sat
152 unsigned32 v1 = GPR[rt];
153 unsigned32 result = 0;
155 for (i = 0; i < 32; i += 16, v1 >>= 16)
157 h0 = (signed16)(v1 & 0xffff);
163 for (j = 14; j >= 15 - shift; j--)
165 if (!(h0 & (1 << j)))
167 DSPCR |= DSPCR_OUFLAG6;
175 for (j = 14; j >= 15 - shift; j--)
179 DSPCR |= DSPCR_OUFLAG6;
190 else if (setcond == 1)
196 if (sat == 1 && shift != 0)
197 h0 += (1 << (shift - 1));
201 result |= ((unsigned32)((unsigned16)h0) << i);
203 GPR[rd] = EXTEND32 (result);
206 :function:::void:do_w_shll:int rd, int rt, int shift
209 unsigned32 v1 = GPR[rt];
210 unsigned32 result = 0;
214 for (i = 30; i >= 31 - shift; i--)
216 if (!(v1 & (1 << i)))
218 DSPCR |= DSPCR_OUFLAG6;
226 for (i = 30; i >= 31 - shift; i--)
230 DSPCR |= DSPCR_OUFLAG6;
238 else if (setcond == 1)
241 result = v1 << shift;
242 GPR[rd] = EXTEND32 (result);
245 :function:::void:do_w_shra:int rd, int rt, int shift
247 unsigned32 result = GPR[rt];
248 signed32 h0 = (signed32)result;
250 h0 += (1 << (shift - 1));
252 GPR[rd] = EXTEND32 (h0);
255 011111,5.RS,5.RT,5.RD,01010,010000:SPECIAL3:32::ADDQ.PH
256 "addq.ph r<RD>, r<RS>, r<RT>"
259 do_ph_op (SD_, RD, RS, RT, 0, 0);
262 011111,5.RS,5.RT,5.RD,01110,010000:SPECIAL3:32::ADDQ_S.PH
263 "addq_s.ph r<RD>, r<RS>, r<RT>"
266 do_ph_op (SD_, RD, RS, RT, 0, 1);
269 011111,5.RS,5.RT,5.RD,10110,010000:SPECIAL3:32::ADDQ_S.W
270 "addq_s.w r<RD>, r<RS>, r<RT>"
273 do_w_op (SD_, RD, RS, RT, 0);
276 011111,5.RS,5.RT,5.RD,00000,010000:SPECIAL3:32::ADDU.QB
277 "addu.qb r<RD>, r<RS>, r<RT>"
280 do_qb_op (SD_, RD, RS, RT, 0, 0);
283 011111,5.RS,5.RT,5.RD,00100,010000:SPECIAL3:32::ADDU_S.QB
284 "addu_s.qb r<RD>, r<RS>, r<RT>"
287 do_qb_op (SD_, RD, RS, RT, 0, 1);
290 011111,5.RS,5.RT,5.RD,01011,010000:SPECIAL3:32::SUBQ.PH
291 "subq.ph r<RD>, r<RS>, r<RT>"
294 do_ph_op (SD_, RD, RS, RT, 1, 0);
297 011111,5.RS,5.RT,5.RD,01111,010000:SPECIAL3:32::SUBQ_S.PH
298 "subq_s.ph r<RD>, r<RS>, r<RT>"
301 do_ph_op (SD_, RD, RS, RT, 1, 1);
304 011111,5.RS,5.RT,5.RD,10111,010000:SPECIAL3:32::SUBQ_S.W
305 "subq_s.w r<RD>, r<RS>, r<RT>"
308 do_w_op (SD_, RD, RS, RT, 1);
311 011111,5.RS,5.RT,5.RD,00001,010000:SPECIAL3:32::SUBU.QB
312 "subu.qb r<RD>, r<RS>, r<RT>"
315 do_qb_op (SD_, RD, RS, RT, 1, 0);
318 011111,5.RS,5.RT,5.RD,00101,010000:SPECIAL3:32::SUBU_S.QB
319 "subu_s.qb r<RD>, r<RS>, r<RT>"
322 do_qb_op (SD_, RD, RS, RT, 1, 1);
325 011111,5.RS,5.RT,5.RD,10000,010000:SPECIAL3:32::ADDSC
326 "addsc r<RD>, r<RS>, r<RT>"
329 unsigned32 v1 = GPR[RS];
330 unsigned32 v2 = GPR[RT];
332 h0 = (unsigned64)v1 + (unsigned64)v2;
333 if (h0 & 0x100000000LL)
334 DSPCR |= DSPCR_CARRY;
335 GPR[RD] = EXTEND32 (h0);
338 011111,5.RS,5.RT,5.RD,10001,010000:SPECIAL3:32::ADDWC
339 "addwc r<RD>, r<RS>, r<RT>"
342 unsigned32 v1 = GPR[RS];
343 unsigned32 v2 = GPR[RT];
345 signed32 h1 = (signed32) v1;
346 signed32 h2 = (signed32) v2;
347 h0 = (signed64)h1 + (signed64)h2
348 + (signed64)((DSPCR >> DSPCR_CARRY_SHIFT) & DSPCR_CARRY_MASK);
349 if (((h0 & 0x100000000LL) >> 1) != (h0 & 0x80000000))
350 DSPCR |= DSPCR_OUFLAG4;
351 GPR[RD] = EXTEND32 (h0);
354 011111,5.RS,5.RT,5.RD,10010,010000:SPECIAL3:32::MODSUB
355 "modsub r<RD>, r<RS>, r<RT>"
358 unsigned32 result = 0;
359 unsigned32 v1 = GPR[RS];
360 unsigned32 v2 = GPR[RT];
361 unsigned32 decr = v2 & 0xff;
362 unsigned32 lastindex = (v2 & 0xffff00) >> 8;
367 GPR[RD] = EXTEND32 (result);
370 011111,5.RS,00000,5.RD,10100,010000:SPECIAL3:32::RADDU.W.QB
371 "raddu.w.qb r<RD>, r<RS>"
376 unsigned32 v1 = GPR[RS];
377 unsigned32 result = 0;
378 for (i = 0; i < 32; i += 8, v1 >>= 8)
380 h0 = (unsigned8)(v1 & 0xff);
381 result += (unsigned32)h0;
383 GPR[RD] = EXTEND32 (result);
386 011111,00000,5.RT,5.RD,01001,010010:SPECIAL3:32::ABSQ_S.PH
387 "absq_s.ph r<RD>, r<RT>"
392 unsigned32 v1 = GPR[RT];
393 unsigned32 result = 0;
394 for (i = 0; i < 32; i += 16, v1 >>= 16)
396 h0 = (signed16)(v1 & 0xffff);
397 if (h0 == (signed16)0x8000)
399 DSPCR |= DSPCR_OUFLAG4;
402 else if (h0 & 0x8000)
404 result |= ((unsigned32)((unsigned16)h0) << i);
406 GPR[RD] = EXTEND32 (result);
409 011111,00000,5.RT,5.RD,10001,010010:SPECIAL3:32::ABSQ_S.W
410 "absq_s.w r<RD>, r<RT>"
413 unsigned32 v1 = GPR[RT];
414 signed32 h0 = (signed32)v1;
415 if (h0 == (signed32)0x80000000)
417 DSPCR |= DSPCR_OUFLAG4;
420 else if (h0 & 0x80000000)
422 GPR[RD] = EXTEND32 (h0);
425 011111,5.RS,5.RT,5.RD,01100,010001:SPECIAL3:32::PRECRQ.QB.PH
426 "precrq.qb.ph r<RD>, r<RS>, r<RT>"
429 unsigned32 v1 = GPR[RS];
430 unsigned32 v2 = GPR[RT];
431 unsigned32 tempu = (v1 & 0xff000000) >> 24;
432 unsigned32 tempv = (v1 & 0xff00) >> 8;
433 unsigned32 tempw = (v2 & 0xff000000) >> 24;
434 unsigned32 tempx = (v2 & 0xff00) >> 8;
435 GPR[RD] = EXTEND32 ((tempu << 24) | (tempv << 16) | (tempw << 8) | tempx);
438 011111,5.RS,5.RT,5.RD,10100,010001:SPECIAL3:32::PRECRQ.PH.W
439 "precrq.ph.w r<RD>, r<RS>, r<RT>"
442 unsigned32 v1 = GPR[RS];
443 unsigned32 v2 = GPR[RT];
444 unsigned32 tempu = (v1 & 0xffff0000) >> 16;
445 unsigned32 tempv = (v2 & 0xffff0000) >> 16;
446 GPR[RD] = EXTEND32 ((tempu << 16) | tempv);
449 011111,5.RS,5.RT,5.RD,10101,010001:SPECIAL3:32::PRECRQ_RS.PH.W
450 "precrq_rs.ph.w r<RD>, r<RS>, r<RT>"
453 unsigned32 v1 = GPR[RS];
454 unsigned32 v2 = GPR[RT];
455 signed32 h1 = (signed32)v1;
456 signed32 h2 = (signed32)v2;
457 signed64 temp1 = (signed64)h1 + (signed64)0x8000;
459 signed64 temp3 = (signed64)h2 + (signed64)0x8000;
461 if (((temp1 & 0x100000000LL) >> 1) != (temp1 & 0x80000000))
463 DSPCR |= DSPCR_OUFLAG6;
467 temp2 = (signed32)((temp1 & 0xffff0000) >> 16);
468 if (((temp3 & 0x100000000LL) >> 1) != (temp3 & 0x80000000))
470 DSPCR |= DSPCR_OUFLAG6;
474 temp4 = (signed32)((temp3 & 0xffff0000) >> 16);
475 GPR[RD] = EXTEND32 ((temp2 << 16) | temp4);
478 011111,5.RS,5.RT,5.RD,01111,010001:SPECIAL3:32::PRECRQU_S.QB.PH
479 "precrqu_s.qb.ph r<RD>, r<RS>, r<RT>"
482 unsigned32 v1 = GPR[RS];
483 unsigned32 v2 = GPR[RT];
484 unsigned32 tempu, tempv, tempw, tempx;
487 DSPCR |= DSPCR_OUFLAG6;
490 else if (!(v1 & 0x80000000) && ((v1 >> 16) > (unsigned32)0x7f80))
492 DSPCR |= DSPCR_OUFLAG6;
496 tempu = (v1 & 0x7f800000) >> 23;
499 DSPCR |= DSPCR_OUFLAG6;
502 else if (!(v1 & 0x8000) && ((v1 & 0xffff) > (unsigned32)0x7f80))
504 DSPCR |= DSPCR_OUFLAG6;
508 tempv = (v1 & 0x7f80) >> 7;
511 DSPCR |= DSPCR_OUFLAG6;
514 else if (!(v2 & 0x80000000) && ((v2 >> 16) > (unsigned32)0x7f80))
516 DSPCR |= DSPCR_OUFLAG6;
520 tempw = (v2 & 0x7f800000) >> 23;
523 DSPCR |= DSPCR_OUFLAG6;
526 else if (!(v2 & 0x8000) && ((v2 & 0xffff) > (unsigned32)0x7f80))
528 DSPCR |= DSPCR_OUFLAG6;
532 tempx = (v2 & 0x7f80) >> 7;
533 GPR[RD] = EXTEND32 ((tempu << 24) | (tempv << 16) | (tempw << 8) | tempx);
536 011111,00000,5.RT,5.RD,01100,010010:SPECIAL3:32::PRECEQ.W.PHL
537 "preceq.w.phl r<RD>, r<RT>"
540 unsigned32 v1 = GPR[RT];
541 GPR[RD] = EXTEND32 (v1 & 0xffff0000);
544 011111,00000,5.RT,5.RD,01101,010010:SPECIAL3:32::PRECEQ.W.PHR
545 "preceq.w.phr r<RD>, r<RT>"
548 unsigned32 v1 = GPR[RT];
549 GPR[RD] = EXTEND32 ((v1 & 0xffff) << 16);
552 011111,00000,5.RT,5.RD,00100,010010:SPECIAL3:32::PRECEQU.PH.QBL
553 "precequ.ph.qbl r<RD>, r<RT>"
556 unsigned32 v1 = GPR[RT];
557 GPR[RD] = EXTEND32 ((v1 & 0xff000000) >> 1) | ((v1 & 0xff0000) >> 9);
560 011111,00000,5.RT,5.RD,00101,010010:SPECIAL3:32::PRECEQU.PH.QBR
561 "precequ.ph.qbr r<RD>, r<RT>"
564 unsigned32 v1 = GPR[RT];
565 GPR[RD] = EXTEND32 ((v1 & 0xff00) << 15) | ((v1 & 0xff) << 7);
568 011111,00000,5.RT,5.RD,00110,010010:SPECIAL3:32::PRECEQU.PH.QBLA
569 "precequ.ph.qbla r<RD>, r<RT>"
572 unsigned32 v1 = GPR[RT];
573 GPR[RD] = EXTEND32 ((v1 & 0xff000000) >> 1) | ((v1 & 0xff00) >> 1);
576 011111,00000,5.RT,5.RD,00111,010010:SPECIAL3:32::PRECEQU.PH.QBRA
577 "precequ.ph.qbra r<RD>, r<RT>"
580 unsigned32 v1 = GPR[RT];
581 GPR[RD] = EXTEND32 ((v1 & 0xff0000) << 7) | ((v1 & 0xff) << 7);
584 011111,00000,5.RT,5.RD,11100,010010:SPECIAL3:32::PRECEU.PH.QBL
585 "preceu.ph.qbl r<RD>, r<RT>"
588 unsigned32 v1 = GPR[RT];
589 GPR[RD] = EXTEND32 ((v1 & 0xff000000) >> 8) | ((v1 & 0xff0000) >> 16);
592 011111,00000,5.RT,5.RD,11101,010010:SPECIAL3:32::PRECEU.PH.QBR
593 "preceu.ph.qbr r<RD>, r<RT>"
596 unsigned32 v1 = GPR[RT];
597 GPR[RD] = EXTEND32 ((v1 & 0xff00) << 8) | (v1 & 0xff);
600 011111,00000,5.RT,5.RD,11110,010010:SPECIAL3:32::PRECEU.PH.QBLA
601 "preceu.ph.qbla r<RD>, r<RT>"
604 unsigned32 v1 = GPR[RT];
605 GPR[RD] = EXTEND32 ((v1 & 0xff000000) >> 8) | ((v1 & 0xff00) >> 8);
608 011111,00000,5.RT,5.RD,11111,010010:SPECIAL3:32::PRECEU.PH.QBRA
609 "preceu.ph.qbra r<RD>, r<RT>"
612 unsigned32 v1 = GPR[RT];
613 GPR[RD] = EXTEND32 ((v1 & 0xff0000) | (v1 & 0xff));
616 011111,00,3.SHIFT3,5.RT,5.RD,00000,010011:SPECIAL3:32::SHLL.QB
617 "shll.qb r<RD>, r<RT>, <SHIFT3>"
620 do_qb_shift (SD_, RD, RT, SHIFT3, 0);
623 011111,5.RS,5.RT,5.RD,00010,010011:SPECIAL3:32::SHLLV.QB
624 "shllv.qb r<RD>, r<RT>, r<RS>"
627 unsigned32 shift = GPR[RS] & 0x7;
628 do_qb_shift (SD_, RD, RT, shift, 0);
631 011111,0,4.SHIFT4,5.RT,5.RD,01000,010011:SPECIAL3:32::SHLL.PH
632 "shll.ph r<RD>, r<RT>, <SHIFT4>"
635 do_ph_shift (SD_, RD, RT, SHIFT4, 0, 0);
638 011111,5.RS,5.RT,5.RD,01010,010011:SPECIAL3:32::SHLLV.PH
639 "shllv.ph r<RD>, r<RT>, r<RS>"
642 unsigned32 shift = GPR[RS] & 0xf;
643 do_ph_shift (SD_, RD, RT, shift, 0, 0);
646 011111,0,4.SHIFT4,5.RT,5.RD,01100,010011:SPECIAL3:32::SHLL_S.PH
647 "shll_s.ph r<RD>, r<RT>, <SHIFT4>"
650 do_ph_shift (SD_, RD, RT, SHIFT4, 0, 1);
653 011111,5.RS,5.RT,5.RD,01110,010011:SPECIAL3:32::SHLLV_S.PH
654 "shllv_s.ph r<RD>, r<RT>, r<RS>"
657 unsigned32 shift = GPR[RS] & 0xf;
658 do_ph_shift (SD_, RD, RT, shift, 0, 1);
661 011111,5.SHIFT5,5.RT,5.RD,10100,010011:SPECIAL3:32::SHLL_S.W
662 "shll_s.w r<RD>, r<RT>, <SHIFT5>"
665 do_w_shll (SD_, RD, RT, SHIFT5);
668 011111,5.RS,5.RT,5.RD,10110,010011:SPECIAL3:32::SHLLV_S.W
669 "shllv_s.w r<RD>, r<RT>, r<RS>"
672 unsigned32 shift = GPR[RS] & 0x1f;
673 do_w_shll (SD_, RD, RT, shift);
676 011111,00,3.SHIFT3,5.RT,5.RD,00001,010011:SPECIAL3:32::SHRL.QB
677 "shrl.qb r<RD>, r<RT>, <SHIFT3>"
680 do_qb_shift (SD_, RD, RT, SHIFT3, 1);
683 011111,5.RS,5.RT,5.RD,00011,010011:SPECIAL3:32::SHRLV.QB
684 "shrlv.qb r<RD>, r<RT>, r<RS>"
687 unsigned32 shift = GPR[RS] & 0x7;
688 do_qb_shift (SD_, RD, RT, shift, 1);
691 011111,0,4.SHIFT4,5.RT,5.RD,01001,010011:SPECIAL3:32::SHRA.PH
692 "shra.ph r<RD>, r<RT>, <SHIFT4>"
695 do_ph_shift (SD_, RD, RT, SHIFT4, 1, 0);
698 011111,5.RS,5.RT,5.RD,01011,010011:SPECIAL3:32::SHRAV.PH
699 "shrav.ph r<RD>, r<RT>, r<RS>"
702 unsigned32 shift = GPR[RS] & 0xf;
703 do_ph_shift (SD_, RD, RT, shift, 1, 0);
706 011111,0,4.SHIFT4,5.RT,5.RD,01101,010011:SPECIAL3:32::SHRA_R.PH
707 "shra_r.ph r<RD>, r<RT>, <SHIFT4>"
710 do_ph_shift (SD_, RD, RT, SHIFT4, 1, 1);
713 011111,5.RS,5.RT,5.RD,01111,010011:SPECIAL3:32::SHRAV_R.PH
714 "shrav_r.ph r<RD>, r<RT>, r<RS>"
717 unsigned32 shift = GPR[RS] & 0xf;
718 do_ph_shift (SD_, RD, RT, shift, 1, 1);
721 011111,5.SHIFT5,5.RT,5.RD,10101,010011:SPECIAL3:32::SHRA_R.W
722 "shra_r.w r<RD>, r<RT>, <SHIFT5>"
725 do_w_shra (SD_, RD, RT, SHIFT5);
728 011111,5.RS,5.RT,5.RD,10111,010011:SPECIAL3:32::SHRAV_R.W
729 "shrav_r.w r<RD>, r<RT>, r<RS>"
732 unsigned32 shift = GPR[RS] & 0x1f;
733 do_w_shra (SD_, RD, RT, shift);
736 // loc: 0 = qhl, 1 = qhr
737 :function:::void:do_qb_muleu:int rd, int rs, int rt, int loc
740 unsigned32 result = 0;
741 unsigned32 v1 = GPR[rs];
742 unsigned32 v2 = GPR[rt];
747 for (i = 0; i < 32; i += 16, v1 >>= 8, v2 >>= 16)
749 h1 = (unsigned16)(v1 & 0xff);
750 h2 = (unsigned16)(v2 & 0xffff);
751 prod = (unsigned32)h1 * (unsigned32)h2;
754 DSPCR |= DSPCR_OUFLAG5;
757 result |= ((unsigned32)prod << i);
759 GPR[rd] = EXTEND32 (result);
762 011111,5.RS,5.RT,5.RD,00110,010000:SPECIAL3:32::MULEU_S.PH.QBL
763 "muleu_s.ph.qbl r<RD>, r<RS>, r<RT>"
766 do_qb_muleu (SD_, RD, RS, RT, 0);
769 011111,5.RS,5.RT,5.RD,00111,010000:SPECIAL3:32::MULEU_S.PH.QBR
770 "muleu_s.ph.qbr r<RD>, r<RS>, r<RT>"
773 do_qb_muleu (SD_, RD, RS, RT, 1);
776 011111,5.RS,5.RT,5.RD,11111,010000:SPECIAL3:32::MULQ_RS.PH
777 "mulq_rs.ph r<RD>, r<RS>, r<RT>"
781 unsigned32 result = 0;
782 unsigned32 v1 = GPR[RS];
783 unsigned32 v2 = GPR[RT];
786 for (i = 0; i < 32; i += 16, v1 >>= 16, v2 >>= 16)
788 h1 = (signed16)(v1 & 0xffff);
789 h2 = (signed16)(v2 & 0xffff);
790 if (h1 == (signed16)0x8000 && h2 == (signed16)0x8000)
792 DSPCR |= DSPCR_OUFLAG5;
796 prod = (((signed32)h1 * (signed32)h2) << 1) + (signed32)0x8000;
798 result |= (((unsigned32)prod >> 16) << i);
800 GPR[RD] = EXTEND32 (result);
803 // loc: 0 = phl, 1 = phr
804 :function:::void:do_ph_muleq:int rd, int rs, int rt, int loc
806 unsigned32 v1 = GPR[rs];
807 unsigned32 v2 = GPR[rt];
812 h1 = (signed16)(v1 >> 16);
813 h2 = (signed16)(v2 >> 16);
817 h1 = (signed16)(v1 & 0xffff);
818 h2 = (signed16)(v2 & 0xffff);
820 if (h1 == (signed16)0x8000 && h2 == (signed16)0x8000)
822 DSPCR |= DSPCR_OUFLAG5;
826 prod = ((signed32)h1 * (signed32)h2) << 1;
827 GPR[rd] = EXTEND32 (prod);
830 011111,5.RS,5.RT,5.RD,11100,010000:SPECIAL3:32::MULEQ_S.W.PHL
831 "muleq_s.w.phl r<RD>, r<RS>, r<RT>"
834 do_ph_muleq (SD_, RD, RS, RT, 0);
837 011111,5.RS,5.RT,5.RD,11101,010000:SPECIAL3:32::MULEQ_S.W.PHR
838 "muleq_s.w.phr r<RD>, r<RS>, r<RT>"
841 do_ph_muleq (SD_, RD, RS, RT, 1);
844 // op: 0 = DPAU 1 = DPSU
845 // loc: 0 = qbl, 1 = qbr
846 :function:::void:do_qb_dot_product:int ac, int rs, int rt, int op, int loc
849 unsigned32 v1 = GPR[rs];
850 unsigned32 v2 = GPR[rt];
852 unsigned32 lo = DSPLO(ac);
853 unsigned32 hi = DSPHI(ac);
854 unsigned64 prod = (((unsigned64)hi) << 32) + (unsigned64)lo;
860 for (i = 0; i < 16; i += 8, v1 >>= 8, v2 >>= 8)
862 h1 = (unsigned8)(v1 & 0xff);
863 h2 = (unsigned8)(v2 & 0xff);
865 prod += (unsigned64)h1 * (unsigned64)h2;
867 prod -= (unsigned64)h1 * (unsigned64)h2;
869 DSPLO(ac) = EXTEND32 (prod);
870 DSPHI(ac) = EXTEND32 (prod >> 32);
873 011111,5.RS,5.RT,000,2.AC,00011,110000:SPECIAL3:32::DPAU.H.QBL
874 "dpau.h.qbl ac<AC>, r<RS>, r<RT>"
877 do_qb_dot_product (SD_, AC, RS, RT, 0, 0);
880 011111,5.RS,5.RT,000,2.AC,00111,110000:SPECIAL3:32::DPAU.H.QBR
881 "dpau.h.qbr ac<AC>, r<RS>, r<RT>"
884 do_qb_dot_product (SD_, AC, RS, RT, 0, 1);
887 011111,5.RS,5.RT,000,2.AC,01011,110000:SPECIAL3:32::DPSU.H.QBL
888 "dpsu.h.qbl ac<AC>, r<RS>, r<RT>"
891 do_qb_dot_product (SD_, AC, RS, RT, 1, 0);
894 011111,5.RS,5.RT,000,2.AC,01111,110000:SPECIAL3:32::DPSU.H.QBR
895 "dpsu.h.qbr ac<AC>, r<RS>, r<RT>"
898 do_qb_dot_product (SD_, AC, RS, RT, 1, 1);
901 // op: 0 = DPAQ 1 = DPSQ
902 :function:::void:do_ph_dot_product:int ac, int rs, int rt, int op
905 unsigned32 v1 = GPR[rs];
906 unsigned32 v2 = GPR[rt];
909 unsigned32 lo = DSPLO(ac);
910 unsigned32 hi = DSPHI(ac);
911 signed64 prod = (signed64)((((unsigned64)hi) << 32) + (unsigned64)lo);
912 for (i = 0; i < 32; i += 16, v1 >>= 16, v2 >>= 16)
914 h1 = (signed16)(v1 & 0xffff);
915 h2 = (signed16)(v2 & 0xffff);
916 if (h1 == (signed16)0x8000 && h2 == (signed16)0x8000)
918 DSPCR |= (1 << (DSPCR_OUFLAG_SHIFT + ac));
919 result = (signed32)0x7fffffff;
922 result = ((signed32)h1 * (signed32)h2) << 1;
925 prod += (signed64)result;
927 prod -= (signed64)result;
929 DSPLO(ac) = EXTEND32 (prod);
930 DSPHI(ac) = EXTEND32 (prod >> 32);
933 011111,5.RS,5.RT,000,2.AC,00100,110000:SPECIAL3:32::DPAQ_S.W.PH
934 "dpaq_s.w.ph ac<AC>, r<RS>, r<RT>"
937 do_ph_dot_product (SD_, AC, RS, RT, 0);
940 011111,5.RS,5.RT,000,2.AC,00101,110000:SPECIAL3:32::DPSQ_S.W.PH
941 "dpsq_s.w.ph ac<AC>, r<RS>, r<RT>"
944 do_ph_dot_product (SD_, AC, RS, RT, 1);
947 011111,5.RS,5.RT,000,2.AC,00110,110000:SPECIAL3:32::MULSAQ_S.W.PH
948 "mulsaq_s.w.ph ac<AC>, r<RS>, r<RT>"
952 unsigned32 v1 = GPR[RS];
953 unsigned32 v2 = GPR[RT];
956 unsigned32 lo = DSPLO(AC);
957 unsigned32 hi = DSPHI(AC);
958 signed64 prod = (signed64)((((unsigned64)hi) << 32) + (unsigned64)lo);
959 for (i = 0; i < 32; i += 16, v1 >>= 16, v2 >>= 16)
961 h1 = (signed16)(v1 & 0xffff);
962 h2 = (signed16)(v2 & 0xffff);
963 if (h1 == (signed16)0x8000 && h2 == (signed16)0x8000)
965 DSPCR |= (1 << (DSPCR_OUFLAG_SHIFT + AC));
966 result = (signed32) 0x7fffffff;
969 result = ((signed32)h1 * (signed32)h2) << 1;
972 prod -= (signed64) result;
974 prod += (signed64) result;
976 DSPLO(AC) = EXTEND32 (prod);
977 DSPHI(AC) = EXTEND32 (prod >> 32);
980 // op: 0 = DPAQ 1 = DPSQ
981 :function:::void:do_w_dot_product:int ac, int rs, int rt, int op
983 unsigned32 v1 = GPR[rs];
984 unsigned32 v2 = GPR[rt];
987 unsigned32 lo = DSPLO(ac);
988 unsigned32 hi = DSPHI(ac);
996 if (h1 == 0x80000000 && h2 == 0x80000000)
998 DSPCR |= (1 << (DSPCR_OUFLAG_SHIFT + ac));
999 result = (signed64) 0x7fffffffffffffffLL;
1002 result = ((signed64)h1 * (signed64)h2) << 1;
1003 resultlo = (unsigned32)(result);
1004 resulthi = (unsigned32)(result >> 32);
1007 temp1 = (unsigned64)lo + (unsigned64)resultlo;
1008 carry = (unsigned32)((temp1 >> 32) & 1);
1009 temp2 = (signed64)((signed32)hi) + (signed64)((signed32)resulthi) +
1010 (signed64)((signed32)carry);
1014 temp1 = (unsigned64)lo - (unsigned64)resultlo;
1015 carry = (unsigned32)((temp1 >> 32) & 1);
1016 temp2 = (signed64)((signed32)hi) - (signed64)((signed32)resulthi) -
1017 (signed64)((signed32)carry);
1019 if (((temp2 & 0x100000000LL) >> 1) != (temp2 & 0x80000000LL))
1021 DSPCR |= (1 << (DSPCR_OUFLAG_SHIFT + ac));
1022 if (temp2 & 0x100000000LL)
1024 DSPLO(ac) = EXTEND32 (0x00000000);
1025 DSPHI(ac) = EXTEND32 (0x80000000);
1029 DSPLO(ac) = EXTEND32 (0xffffffff);
1030 DSPHI(ac) = EXTEND32 (0x7fffffff);
1035 DSPLO(ac) = EXTEND32 (temp1);
1036 DSPHI(ac) = EXTEND32 (temp2);
1040 011111,5.RS,5.RT,000,2.AC,01100,110000:SPECIAL3:32::DPAQ_SA.L.W
1041 "dpaq_sa.l.w ac<AC>, r<RS>, r<RT>"
1044 do_w_dot_product (SD_, AC, RS, RT, 0);
1047 011111,5.RS,5.RT,000,2.AC,01101,110000:SPECIAL3:32::DPSQ_SA.L.W
1048 "dpsq_sa.l.w ac<AC>, r<RS>, r<RT>"
1051 do_w_dot_product (SD_, AC, RS, RT, 1);
1054 // op: 0 = MAQ_S 1 = MAQ_SA
1055 // loc: 0 = phl, 1 = phr
1056 :function:::void:do_ph_maq:int ac, int rs, int rt, int op, int loc
1059 unsigned32 v1 = GPR[rs];
1060 unsigned32 v2 = GPR[rt];
1063 unsigned32 lo = DSPLO(ac);
1064 unsigned32 hi = DSPHI(ac);
1065 signed64 prod = (signed64)((((unsigned64)hi) << 32) + (unsigned64)lo);
1068 h1 = (signed16)(v1 >> 16);
1069 h2 = (signed16)(v2 >> 16);
1073 h1 = (signed16)(v1 & 0xffff);
1074 h2 = (signed16)(v2 & 0xffff);
1076 if (h1 == (signed16)0x8000 && h2 == (signed16)0x8000)
1078 DSPCR |= (1 << (DSPCR_OUFLAG_SHIFT + ac));
1079 result = (signed32)0x7fffffff;
1082 result = ((signed32)h1 * (signed32)h2) << 1;
1083 prod += (signed64)result;
1084 if (op == 1) // MAQ_SA
1086 if (prod & 0x8000000000000000LL)
1088 for (i = 62; i >= 31; i--)
1090 if (!(prod & ((signed64)1 << i)))
1092 DSPCR |= (1 << (DSPCR_OUFLAG_SHIFT + ac));
1093 prod = 0xffffffff80000000LL;
1100 for (i = 62; i >= 31; i--)
1102 if (prod & ((signed64)1 << i))
1104 DSPCR |= (1 << (DSPCR_OUFLAG_SHIFT + ac));
1111 DSPLO(ac) = EXTEND32 (prod);
1112 DSPHI(ac) = EXTEND32 (prod >> 32);
1115 011111,5.RS,5.RT,000,2.AC,10100,110000:SPECIAL3:32::MAQ_S.W.PHL
1116 "maq_s.w.phl ac<AC>, r<RS>, r<RT>"
1119 do_ph_maq (SD_, AC, RS, RT, 0, 0);
1122 011111,5.RS,5.RT,000,2.AC,10110,110000:SPECIAL3:32::MAQ_S.W.PHR
1123 "maq_s.w.phr ac<AC>, r<RS>, r<RT>"
1126 do_ph_maq (SD_, AC, RS, RT, 0, 1);
1129 011111,5.RS,5.RT,000,2.AC,10000,110000:SPECIAL3:32::MAQ_SA.W.PHL
1130 "maq_sa.w.phl ac<AC>, r<RS>, r<RT>"
1133 do_ph_maq (SD_, AC, RS, RT, 1, 0);
1136 011111,5.RS,5.RT,000,2.AC,10010,110000:SPECIAL3:32::MAQ_SA.W.PHR
1137 "maq_sa.w.phr ac<AC>, r<RS>, r<RT>"
1140 do_ph_maq (SD_, AC, RS, RT, 1, 1);
1143 011111,00000,5.RT,5.RD,11011,010010:SPECIAL3:32::BITREV
1144 "bitrev r<RD>, r<RT>"
1148 unsigned32 v1 = GPR[RT];
1150 for (i = 0; i < 16; i++)
1153 h1 |= (1 << (15 - i));
1155 GPR[RD] = EXTEND32 (h1);
1158 011111,5.RS,5.RT,00000,00000,001100:SPECIAL3:32::INSV
1162 unsigned32 v1 = GPR[RS];
1163 unsigned32 v2 = GPR[RT];
1164 unsigned32 pos = (DSPCR >> DSPCR_POS_SHIFT) & DSPCR_POS_MASK;
1165 unsigned32 size = (DSPCR >> DSPCR_SCOUNT_SHIFT) & DSPCR_SCOUNT_MASK;
1166 unsigned32 mask1, mask2, mask3, result;
1168 mask1 = (1 << size) - 1;
1171 mask2 = (1 << pos) - 1;
1172 if (pos + size < 32)
1173 mask3 = ~((1 << (pos + size)) - 1);
1176 result = (v2 & mask3) | ((v1 & mask1) << pos) | (v2 & mask2);
1177 GPR[RT] = EXTEND32 (result);
1180 011111,00,8.IMM8,5.RD,00010,010010:SPECIAL3:32::REPL.QB
1181 "repl.qb r<RD>, <IMM8>"
1184 GPR[RD] = EXTEND32 ((IMM8 << 24) | (IMM8 << 16) | (IMM8 << 8) | IMM8);
1187 011111,00000,5.RT,5.RD,00011,010010:SPECIAL3:32::REPLV.QB
1188 "replv.qb r<RD>, r<RT>"
1191 unsigned32 v1 = GPR[RT];
1193 GPR[RD] = EXTEND32 ((v1 << 24) | (v1 << 16) | (v1 << 8) | v1);
1196 011111,10.IMM10,5.RD,01010,010010:SPECIAL3:32::REPL.PH
1197 "repl.ph r<RD>, <IMM10>"
1200 signed32 v1 = IMM10;
1203 GPR[RD] = EXTEND32 ((v1 << 16) | (v1 & 0xffff));
1206 011111,00000,5.RT,5.RD,01011,010010:SPECIAL3:32::REPLV.PH
1207 "replv.ph r<RD>, r<RT>"
1210 unsigned32 v1 = GPR[RT];
1212 GPR[RD] = EXTEND32 ((v1 << 16) | v1);
1215 // op: 0 = EQ, 1 = LT, 2 = LE
1216 :function:::void:do_qb_cmpu:int rs, int rt, int op
1219 unsigned32 v1 = GPR[rs];
1220 unsigned32 v2 = GPR[rt];
1223 for (i = 0, j = 0; i < 32; i += 8, j++, v1 >>= 8, v2 >>= 8)
1225 h1 = (unsigned8)(v1 & 0xff);
1226 h2 = (unsigned8)(v2 & 0xff);
1227 mask = ~(1 << (DSPCR_CCOND_SHIFT + j));
1230 DSPCR |= ((h1 == h2) << (DSPCR_CCOND_SHIFT + j));
1231 else if (op == 1) // LT
1232 DSPCR |= ((h1 < h2) << (DSPCR_CCOND_SHIFT + j));
1234 DSPCR |= ((h1 <= h2) << (DSPCR_CCOND_SHIFT + j));
1238 011111,5.RS,5.RT,00000,00000,010001:SPECIAL3:32::CMPU.EQ.QB
1239 "cmpu.eq.qb r<RS>, r<RT>"
1242 do_qb_cmpu (SD_, RS, RT, 0);
1245 011111,5.RS,5.RT,00000,00001,010001:SPECIAL3:32::CMPU.LT.QB
1246 "cmpu.lt.qb r<RS>, r<RT>"
1249 do_qb_cmpu (SD_, RS, RT, 1);
1252 011111,5.RS,5.RT,00000,00010,010001:SPECIAL3:32::CMPU.LE.QB
1253 "cmpu.le.qb r<RS>, r<RT>"
1256 do_qb_cmpu (SD_, RS, RT, 2);
1259 // op: 0 = EQ, 1 = LT, 2 = LE
1260 :function:::void:do_qb_cmpgu:int rd, int rs, int rt, int op
1263 unsigned32 v1 = GPR[rs];
1264 unsigned32 v2 = GPR[rt];
1266 unsigned32 result = 0;
1267 for (i = 0, j = 0; i < 32; i += 8, j++, v1 >>= 8, v2 >>= 8)
1269 h1 = (unsigned8)(v1 & 0xff);
1270 h2 = (unsigned8)(v2 & 0xff);
1272 result |= ((h1 == h2) << j);
1273 else if (op == 1) // LT
1274 result |= ((h1 < h2) << j);
1276 result |= ((h1 <= h2) << j);
1278 GPR[rd] = EXTEND32 (result);
1281 011111,5.RS,5.RT,5.RD,00100,010001:SPECIAL3:32::CMPGU.EQ.QB
1282 "cmpgu.eq.qb r<RD>, r<RS>, r<RT>"
1285 do_qb_cmpgu (SD_, RD, RS, RT, 0);
1288 011111,5.RS,5.RT,5.RD,00101,010001:SPECIAL3:32::CMPGU.LT.QB
1289 "cmpgu.lt.qb r<RD>, r<RS>, r<RT>"
1292 do_qb_cmpgu (SD_, RD, RS, RT, 1);
1295 011111,5.RS,5.RT,5.RD,00110,010001:SPECIAL3:32::CMPGU.LE.QB
1296 "cmpgu.le.qb r<RD>, r<RS>, r<RT>"
1299 do_qb_cmpgu (SD_, RD, RS, RT, 2);
1302 // op: 0 = EQ, 1 = LT, 2 = LE
1303 :function:::void:do_ph_cmpu:int rs, int rt, int op
1306 unsigned32 v1 = GPR[rs];
1307 unsigned32 v2 = GPR[rt];
1310 for (i = 0, j = 0; i < 32; i += 16, j++, v1 >>= 16, v2 >>= 16)
1312 h1 = (signed16)(v1 & 0xffff);
1313 h2 = (signed16)(v2 & 0xffff);
1314 mask = ~(1 << (DSPCR_CCOND_SHIFT + j));
1317 DSPCR |= ((h1 == h2) << (DSPCR_CCOND_SHIFT + j));
1318 else if (op == 1) // LT
1319 DSPCR |= ((h1 < h2) << (DSPCR_CCOND_SHIFT + j));
1321 DSPCR |= ((h1 <= h2) << (DSPCR_CCOND_SHIFT + j));
1325 011111,5.RS,5.RT,00000,01000,010001:SPECIAL3:32::CMP.EQ.PH
1326 "cmp.eq.ph r<RS>, r<RT>"
1329 do_ph_cmpu (SD_, RS, RT, 0);
1332 011111,5.RS,5.RT,00000,01001,010001:SPECIAL3:32::CMP.LT.PH
1333 "cmp.lt.ph r<RS>, r<RT>"
1336 do_ph_cmpu (SD_, RS, RT, 1);
1339 011111,5.RS,5.RT,00000,01010,010001:SPECIAL3:32::CMP.LE.PH
1340 "cmp.le.ph r<RS>, r<RT>"
1343 do_ph_cmpu (SD_, RS, RT, 2);
1346 011111,5.RS,5.RT,5.RD,00011,010001:SPECIAL3:32::PICK.QB
1347 "pick.qb r<RD>, r<RS>, r<RT>"
1351 unsigned32 v1 = GPR[RS];
1352 unsigned32 v2 = GPR[RT];
1354 unsigned32 result = 0;
1355 for (i = 0, j = 0; i < 32; i += 8, j++, v1 >>= 8, v2 >>= 8)
1357 h1 = (unsigned8)(v1 & 0xff);
1358 h2 = (unsigned8)(v2 & 0xff);
1359 if (DSPCR & (1 << (DSPCR_CCOND_SHIFT + j)))
1360 result |= (unsigned32)(h1 << i);
1362 result |= (unsigned32)(h2 << i);
1364 GPR[RD] = EXTEND32 (result);
1367 011111,5.RS,5.RT,5.RD,01011,010001:SPECIAL3:32::PICK.PH
1368 "pick.ph r<RD>, r<RS>, r<RT>"
1372 unsigned32 v1 = GPR[RS];
1373 unsigned32 v2 = GPR[RT];
1375 unsigned32 result = 0;
1376 for (i = 0, j = 0; i < 32; i += 16, j++, v1 >>= 16, v2 >>= 16)
1378 h1 = (unsigned16)(v1 & 0xffff);
1379 h2 = (unsigned16)(v2 & 0xffff);
1380 if (DSPCR & (1 << (DSPCR_CCOND_SHIFT + j)))
1381 result |= (unsigned32)(h1 << i);
1383 result |= (unsigned32)(h2 << i);
1385 GPR[RD] = EXTEND32 (result);
1388 011111,5.RS,5.RT,5.RD,01110,010001:SPECIAL3:32::PACKRL.PH
1389 "packrl.ph r<RD>, r<RS>, r<RT>"
1392 unsigned32 v1 = GPR[RS];
1393 unsigned32 v2 = GPR[RT];
1394 GPR[RD] = EXTEND32 ((v1 << 16) + (v2 >> 16));
1397 // op: 0 = EXTR, 1 = EXTR_R, 2 = EXTR_RS
1398 :function:::void:do_w_extr:int rt, int ac, int shift, int op
1401 unsigned32 lo = DSPLO(ac);
1402 unsigned32 hi = DSPHI(ac);
1403 unsigned64 prod = (((unsigned64)hi) << 32) + (unsigned64)lo;
1404 signed64 result = (signed64)prod;
1406 if (!(prod & 0x8000000000000000LL))
1408 for (i = 62; i >= (shift + 31); i--)
1410 if (prod & ((unsigned64)1 << i))
1412 DSPCR |= DSPCR_OUFLAG7;
1417 if (((prod >> (shift - 1)) & 0xffffffffLL) == 0xffffffffLL)
1419 DSPCR |= DSPCR_OUFLAG7;
1425 for (i = 62; i >= (shift + 31); i--)
1427 if (!(prod & ((unsigned64)1 << i)))
1429 DSPCR |= DSPCR_OUFLAG7;
1435 if (op == 0) // EXTR
1436 result = result >> shift;
1437 else if (op == 1) // EXTR_R
1440 result = ((result >> (shift - 1)) + 1) >> 1;
1442 result = result >> shift;
1447 result = 0x7fffffff;
1448 else if (setcond == 2)
1449 result = 0x80000000;
1453 result = ((result >> (shift - 1)) + 1) >> 1;
1455 result = result >> shift;
1458 GPR[rt] = EXTEND32 (result);
1461 011111,5.SHIFT,5.RT,000,2.AC,00000,111000:SPECIAL3:32::EXTR.W
1462 "extr.w r<RT>, ac<AC>, <SHIFT>"
1465 do_w_extr (SD_, RT, AC, SHIFT, 0);
1468 011111,5.RS,5.RT,000,2.AC,00001,111000:SPECIAL3:32::EXTRV.W
1469 "extrv.w r<RT>, ac<AC>, r<RS>"
1472 unsigned32 shift = GPR[RS] & 0x1f;
1473 do_w_extr (SD_, RT, AC, shift, 0);
1476 011111,5.SHIFT,5.RT,000,2.AC,00100,111000:SPECIAL3:32::EXTR_R.W
1477 "extr_r.w r<RT>, ac<AC>, <SHIFT>"
1480 do_w_extr (SD_, RT, AC, SHIFT, 1);
1483 011111,5.RS,5.RT,000,2.AC,00101,111000:SPECIAL3:32::EXTRV_R.W
1484 "extrv_r.w r<RT>, ac<AC>, r<RS>"
1487 unsigned32 shift = GPR[RS] & 0x1f;
1488 do_w_extr (SD_, RT, AC, shift, 1);
1491 011111,5.SHIFT,5.RT,000,2.AC,00110,111000:SPECIAL3:32::EXTR_RS.W
1492 "extr_rs.w r<RT>, ac<AC>, <SHIFT>"
1495 do_w_extr (SD_, RT, AC, SHIFT, 2);
1498 011111,5.RS,5.RT,000,2.AC,00111,111000:SPECIAL3:32::EXTRV_RS.W
1499 "extrv_rs.w r<RT>, ac<AC>, r<RS>"
1502 unsigned32 shift = GPR[RS] & 0x1f;
1503 do_w_extr (SD_, RT, AC, shift, 2);
1506 :function:::void:do_h_extr:int rt, int ac, int shift
1509 unsigned32 lo = DSPLO(ac);
1510 unsigned32 hi = DSPHI(ac);
1511 unsigned64 prod = (((unsigned64)hi) << 32) + (unsigned64)lo;
1512 signed64 result = (signed64)prod;
1513 signed64 value = 0xffffffffffff8000LL;
1515 if (result > 0x7fff)
1518 DSPCR |= DSPCR_OUFLAG7;
1520 else if (result < value)
1523 DSPCR |= DSPCR_OUFLAG7;
1525 GPR[rt] = EXTEND32 (result);
1528 011111,5.SHIFT,5.RT,000,2.AC,01110,111000:SPECIAL3:32::EXTR_S.H
1529 "extr_s.h r<RT>, ac<AC>, <SHIFT>"
1532 do_h_extr (SD_, RT, AC, SHIFT);
1535 011111,5.RS,5.RT,000,2.AC,01111,111000:SPECIAL3:32::EXTRV_S.H
1536 "extrv_s.h r<RT>, ac<AC>, r<RS>"
1539 unsigned32 shift = GPR[RS] & 0x1f;
1540 do_h_extr (SD_, RT, AC, shift);
1543 // op: 0 = EXTP, 1 = EXTPDP
1544 :function:::void:do_extp:int rt, int ac, int size, int op
1546 signed32 pos = (DSPCR >> DSPCR_POS_SHIFT) & DSPCR_POS_MASK;
1547 unsigned32 lo = DSPLO(ac);
1548 unsigned32 hi = DSPHI(ac);
1549 unsigned64 prod = (((unsigned64)hi) << 32) + (unsigned64)lo;
1550 unsigned64 result = 0;
1551 if (pos - (size + 1) >= -1)
1553 prod >>= (pos - size);
1554 result = prod & (((unsigned64)1 << (size + 1)) - 1);
1555 DSPCR &= (~DSPCR_EFI_SMASK);
1556 if (op == 1) // EXTPDP
1558 if (pos - (size + 1) >= 0)
1560 DSPCR &= (~DSPCR_POS_SMASK);
1561 DSPCR |= ((pos - (size + 1)) & DSPCR_POS_MASK) << DSPCR_POS_SHIFT;
1563 else if (pos - (size + 1) == -1)
1565 DSPCR |= DSPCR_POS_SMASK;
1574 GPR[rt] = EXTEND32 (result);
1577 011111,5.SIZE,5.RT,000,2.AC,00010,111000:SPECIAL3:32::EXTP
1578 "extp r<RT>, ac<AC>, <SIZE>"
1581 do_extp (SD_, RT, AC, SIZE, 0);
1584 011111,5.RS,5.RT,000,2.AC,00011,111000:SPECIAL3:32::EXTPV
1585 "extpv r<RT>, ac<AC>, r<RS>"
1588 unsigned32 size = GPR[RS] & 0x1f;
1589 do_extp (SD_, RT, AC, size, 0);
1592 011111,5.SIZE,5.RT,000,2.AC,01010,111000:SPECIAL3:32::EXTPDP
1593 "extpdp r<RT>, ac<AC>, <SIZE>"
1596 do_extp (SD_, RT, AC, SIZE, 1);
1599 011111,5.RS,5.RT,000,2.AC,01011,111000:SPECIAL3:32::EXTPDPV
1600 "extpdpv r<RT>, ac<AC>, r<RS>"
1603 unsigned32 size = GPR[RS] & 0x1f;
1604 do_extp (SD_, RT, AC, size, 1);
1607 :function:::void:do_shilo:int ac, int shift
1609 unsigned32 lo = DSPLO(ac);
1610 unsigned32 hi = DSPHI(ac);
1611 unsigned64 prod = (((unsigned64)hi) << 32) + (unsigned64)lo;
1618 DSPLO(ac) = EXTEND32 (prod);
1619 DSPHI(ac) = EXTEND32 (prod >> 32);
1622 011111,6.SHIFT6,0000,000,2.AC,11010,111000:SPECIAL3:32::SHILO
1623 "shilo ac<AC>, <SHIFT6>"
1626 do_shilo (SD_, AC, SHIFT6);
1629 011111,5.RS,00000,000,2.AC,11011,111000:SPECIAL3:32::SHILOV
1630 "shilov ac<AC>, r<RS>"
1633 signed32 shift = GPR[RS] & 0x3f;
1634 do_shilo (SD_, AC, shift);
1637 011111,5.RS,00000,000,2.AC,11111,111000:SPECIAL3:32::MTHLIP
1638 "mthlip r<RS>, ac<AC>"
1641 unsigned32 pos = (DSPCR >> DSPCR_POS_SHIFT) & DSPCR_POS_MASK;
1642 DSPHI(AC) = DSPLO(AC);
1643 DSPLO(AC) = GPR[RS];
1648 DSPCR &= (~DSPCR_POS_SMASK);
1649 DSPCR |= (pos & DSPCR_POS_MASK) << DSPCR_POS_SHIFT;
1652 000000,000,2.AC,00000,5.RD,00000,010000:SPECIAL:32::MFHIdsp
1653 "mfhi r<RD>":AC == 0
1654 "mfhi r<RD>, ac<AC>"
1664 GPR[RD] = DSPHI(AC);
1667 000000,000,2.AC,00000,5.RD,00000,010010:SPECIAL:32::MFLOdsp
1668 "mflo r<RD>":AC == 0
1669 "mflo r<RD>, ac<AC>"
1679 GPR[RD] = DSPLO(AC);
1682 000000,5.RS,00000,000,2.AC,00000,010001:SPECIAL:32::MTHIdsp
1683 "mthi r<RS>":AC == 0
1684 "mthi r<RS>, ac<AC>"
1692 check_mt_hilo (SD_, HIHISTORY);
1693 DSPHI(AC) = GPR[RS];
1696 000000,5.RS,00000,000,2.AC,00000,010011:SPECIAL:32::MTLOdsp
1697 "mtlo r<RS>":AC == 0
1698 "mtlo r<RS>, ac<AC>"
1706 check_mt_hilo (SD_, LOHISTORY);
1707 DSPLO(AC) = GPR[RS];
1710 011111,5.RS,10.MASK10,10011,111000:SPECIAL3:32::WRDSP
1711 "wrdsp r<RS>":MASK10 == 1111111111
1712 "wrdsp r<RS>, <MASK10>"
1715 unsigned32 v1 = GPR[RS];
1718 DSPCR &= (~DSPCR_POS_SMASK);
1719 DSPCR |= (v1 & DSPCR_POS_SMASK);
1723 DSPCR &= (~DSPCR_SCOUNT_SMASK);
1724 DSPCR |= (v1 & DSPCR_SCOUNT_SMASK);
1728 DSPCR &= (~DSPCR_CARRY_SMASK);
1729 DSPCR |= (v1 & DSPCR_CARRY_SMASK);
1733 DSPCR &= (~DSPCR_OUFLAG_SMASK);
1734 DSPCR |= (v1 & DSPCR_OUFLAG_SMASK);
1738 DSPCR &= (~DSPCR_CCOND_SMASK);
1739 DSPCR |= (v1 & DSPCR_CCOND_SMASK);
1743 DSPCR &= (~DSPCR_EFI_SMASK);
1744 DSPCR |= (v1 & DSPCR_EFI_SMASK);
1748 011111,10.MASK10,5.RD,10010,111000:SPECIAL3:32::RDDSP
1749 "rddsp r<RD>":MASK10 == 1111111111
1750 "rddsp r<RD>, <MASK10>"
1753 unsigned32 result = 0;
1756 result &= (~DSPCR_POS_SMASK);
1757 result |= (DSPCR & DSPCR_POS_SMASK);
1761 result &= (~DSPCR_SCOUNT_SMASK);
1762 result |= (DSPCR & DSPCR_SCOUNT_SMASK);
1766 result &= (~DSPCR_CARRY_SMASK);
1767 result |= (DSPCR & DSPCR_CARRY_SMASK);
1771 result &= (~DSPCR_OUFLAG_SMASK);
1772 result |= (DSPCR & DSPCR_OUFLAG_SMASK);
1776 result &= (~DSPCR_CCOND_SMASK);
1777 result |= (DSPCR & DSPCR_CCOND_SMASK);
1781 result &= (~DSPCR_EFI_SMASK);
1782 result |= (DSPCR & DSPCR_EFI_SMASK);
1784 GPR[RD] = EXTEND32 (result);
1787 011111,5.BASE,5.INDEX,5.RD,00110,001010:SPECIAL3:32::LBUX
1788 "lbux r<RD>, r<INDEX>(r<BASE>)"
1791 GPR[RD] = do_load (SD_, AccessLength_BYTE, GPR[BASE], GPR[INDEX]);
1794 011111,5.BASE,5.INDEX,5.RD,00100,001010:SPECIAL3:32::LHX
1795 "lhx r<RD>, r<INDEX>(r<BASE>)"
1798 GPR[RD] = EXTEND16 (do_load (SD_, AccessLength_HALFWORD, GPR[BASE], GPR[INDEX]));
1801 011111,5.BASE,5.INDEX,5.RD,00000,001010:SPECIAL3:32::LWX
1802 "lwx r<RD>, r<INDEX>(r<BASE>)"
1805 GPR[RD] = EXTEND32 (do_load (SD_, AccessLength_WORD, GPR[BASE], GPR[INDEX]));
1808 000001,00000,11100,16.OFFSET:REGIMM:32::BPOSGE32
1812 unsigned32 pos = (DSPCR >> DSPCR_POS_SHIFT) & DSPCR_POS_MASK;
1813 address_word offset = EXTEND16 (OFFSET) << 2;
1816 DELAY_SLOT (NIA + offset);