Statistics
| Branch: | Revision:

root / target-mips / op.c @ 5a1e8ffb

History | View | Annotate | Download (64.1 kB)

1
/*
2
 *  MIPS emulation micro-operations for qemu.
3
 * 
4
 *  Copyright (c) 2004-2005 Jocelyn Mayer
5
 *  Copyright (c) 2006 Marius Groeger (FPU operations)
6
 *
7
 * This library is free software; you can redistribute it and/or
8
 * modify it under the terms of the GNU Lesser General Public
9
 * License as published by the Free Software Foundation; either
10
 * version 2 of the License, or (at your option) any later version.
11
 *
12
 * This library is distributed in the hope that it will be useful,
13
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15
 * Lesser General Public License for more details.
16
 *
17
 * You should have received a copy of the GNU Lesser General Public
18
 * License along with this library; if not, write to the Free Software
19
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
20
 */
21

    
22
#include "config.h"
23
#include "exec.h"
24

    
25
#ifndef CALL_FROM_TB0
26
#define CALL_FROM_TB0(func) func()
27
#endif
28
#ifndef CALL_FROM_TB1
29
#define CALL_FROM_TB1(func, arg0) func(arg0)
30
#endif
31
#ifndef CALL_FROM_TB1_CONST16
32
#define CALL_FROM_TB1_CONST16(func, arg0) CALL_FROM_TB1(func, arg0)
33
#endif
34
#ifndef CALL_FROM_TB2
35
#define CALL_FROM_TB2(func, arg0, arg1) func(arg0, arg1)
36
#endif
37
#ifndef CALL_FROM_TB2_CONST16
38
#define CALL_FROM_TB2_CONST16(func, arg0, arg1)     \
39
        CALL_FROM_TB2(func, arg0, arg1)
40
#endif
41
#ifndef CALL_FROM_TB3
42
#define CALL_FROM_TB3(func, arg0, arg1, arg2) func(arg0, arg1, arg2)
43
#endif
44
#ifndef CALL_FROM_TB4
45
#define CALL_FROM_TB4(func, arg0, arg1, arg2, arg3) \
46
        func(arg0, arg1, arg2, arg3)
47
#endif
48

    
49
#define REG 1
50
#include "op_template.c"
51
#undef REG
52
#define REG 2
53
#include "op_template.c"
54
#undef REG
55
#define REG 3
56
#include "op_template.c"
57
#undef REG
58
#define REG 4
59
#include "op_template.c"
60
#undef REG
61
#define REG 5
62
#include "op_template.c"
63
#undef REG
64
#define REG 6
65
#include "op_template.c"
66
#undef REG
67
#define REG 7
68
#include "op_template.c"
69
#undef REG
70
#define REG 8
71
#include "op_template.c"
72
#undef REG
73
#define REG 9
74
#include "op_template.c"
75
#undef REG
76
#define REG 10
77
#include "op_template.c"
78
#undef REG
79
#define REG 11
80
#include "op_template.c"
81
#undef REG
82
#define REG 12
83
#include "op_template.c"
84
#undef REG
85
#define REG 13
86
#include "op_template.c"
87
#undef REG
88
#define REG 14
89
#include "op_template.c"
90
#undef REG
91
#define REG 15
92
#include "op_template.c"
93
#undef REG
94
#define REG 16
95
#include "op_template.c"
96
#undef REG
97
#define REG 17
98
#include "op_template.c"
99
#undef REG
100
#define REG 18
101
#include "op_template.c"
102
#undef REG
103
#define REG 19
104
#include "op_template.c"
105
#undef REG
106
#define REG 20
107
#include "op_template.c"
108
#undef REG
109
#define REG 21
110
#include "op_template.c"
111
#undef REG
112
#define REG 22
113
#include "op_template.c"
114
#undef REG
115
#define REG 23
116
#include "op_template.c"
117
#undef REG
118
#define REG 24
119
#include "op_template.c"
120
#undef REG
121
#define REG 25
122
#include "op_template.c"
123
#undef REG
124
#define REG 26
125
#include "op_template.c"
126
#undef REG
127
#define REG 27
128
#include "op_template.c"
129
#undef REG
130
#define REG 28
131
#include "op_template.c"
132
#undef REG
133
#define REG 29
134
#include "op_template.c"
135
#undef REG
136
#define REG 30
137
#include "op_template.c"
138
#undef REG
139
#define REG 31
140
#include "op_template.c"
141
#undef REG
142

    
143
#define TN
144
#include "op_template.c"
145
#undef TN
146

    
147
#define FREG 0
148
#include "fop_template.c"
149
#undef FREG
150
#define FREG 1
151
#include "fop_template.c"
152
#undef FREG
153
#define FREG 2
154
#include "fop_template.c"
155
#undef FREG
156
#define FREG 3
157
#include "fop_template.c"
158
#undef FREG
159
#define FREG 4
160
#include "fop_template.c"
161
#undef FREG
162
#define FREG 5
163
#include "fop_template.c"
164
#undef FREG
165
#define FREG 6
166
#include "fop_template.c"
167
#undef FREG
168
#define FREG 7
169
#include "fop_template.c"
170
#undef FREG
171
#define FREG 8
172
#include "fop_template.c"
173
#undef FREG
174
#define FREG 9
175
#include "fop_template.c"
176
#undef FREG
177
#define FREG 10
178
#include "fop_template.c"
179
#undef FREG
180
#define FREG 11
181
#include "fop_template.c"
182
#undef FREG
183
#define FREG 12
184
#include "fop_template.c"
185
#undef FREG
186
#define FREG 13
187
#include "fop_template.c"
188
#undef FREG
189
#define FREG 14
190
#include "fop_template.c"
191
#undef FREG
192
#define FREG 15
193
#include "fop_template.c"
194
#undef FREG
195
#define FREG 16
196
#include "fop_template.c"
197
#undef FREG
198
#define FREG 17
199
#include "fop_template.c"
200
#undef FREG
201
#define FREG 18
202
#include "fop_template.c"
203
#undef FREG
204
#define FREG 19
205
#include "fop_template.c"
206
#undef FREG
207
#define FREG 20
208
#include "fop_template.c"
209
#undef FREG
210
#define FREG 21
211
#include "fop_template.c"
212
#undef FREG
213
#define FREG 22
214
#include "fop_template.c"
215
#undef FREG
216
#define FREG 23
217
#include "fop_template.c"
218
#undef FREG
219
#define FREG 24
220
#include "fop_template.c"
221
#undef FREG
222
#define FREG 25
223
#include "fop_template.c"
224
#undef FREG
225
#define FREG 26
226
#include "fop_template.c"
227
#undef FREG
228
#define FREG 27
229
#include "fop_template.c"
230
#undef FREG
231
#define FREG 28
232
#include "fop_template.c"
233
#undef FREG
234
#define FREG 29
235
#include "fop_template.c"
236
#undef FREG
237
#define FREG 30
238
#include "fop_template.c"
239
#undef FREG
240
#define FREG 31
241
#include "fop_template.c"
242
#undef FREG
243

    
244
#define FTN
245
#include "fop_template.c"
246
#undef FTN
247

    
248
void op_dup_T0 (void)
249
{
250
    T2 = T0;
251
    RETURN();
252
}
253

    
254
void op_load_HI (void)
255
{
256
    T0 = env->HI;
257
    RETURN();
258
}
259

    
260
void op_store_HI (void)
261
{
262
    env->HI = T0;
263
    RETURN();
264
}
265

    
266
void op_load_LO (void)
267
{
268
    T0 = env->LO;
269
    RETURN();
270
}
271

    
272
void op_store_LO (void)
273
{
274
    env->LO = T0;
275
    RETURN();
276
}
277

    
278
/* Load and store */
279
#define MEMSUFFIX _raw
280
#include "op_mem.c"
281
#undef MEMSUFFIX
282
#if !defined(CONFIG_USER_ONLY)
283
#define MEMSUFFIX _user
284
#include "op_mem.c"
285
#undef MEMSUFFIX
286

    
287
#define MEMSUFFIX _kernel
288
#include "op_mem.c"
289
#undef MEMSUFFIX
290
#endif
291

    
292
/* Addresses computation */
293
void op_addr_add (void)
294
{
295
/* For compatibility with 32-bit code, data reference in user mode
296
   with Status_UX = 0 should be casted to 32-bit and sign extended.
297
   See the MIPS64 PRA manual, section 4.10. */
298
#ifdef TARGET_MIPS64
299
    if ((env->CP0_Status & (1 << CP0St_UM)) &&
300
        !(env->CP0_Status & (1 << CP0St_UX)))
301
        T0 = (int64_t)(int32_t)(T0 + T1);
302
    else
303
#endif
304
        T0 += T1;
305
    RETURN();
306
}
307

    
308
/* Arithmetic */
309
void op_add (void)
310
{
311
    T0 = (int32_t)((int32_t)T0 + (int32_t)T1);
312
    RETURN();
313
}
314

    
315
void op_addo (void)
316
{
317
    target_ulong tmp;
318

    
319
    tmp = (int32_t)T0;
320
    T0 = (int32_t)T0 + (int32_t)T1;
321
    if (((tmp ^ T1 ^ (-1)) & (T0 ^ T1)) >> 31) {
322
        /* operands of same sign, result different sign */
323
        CALL_FROM_TB1(do_raise_exception, EXCP_OVERFLOW);
324
    }
325
    T0 = (int32_t)T0;
326
    RETURN();
327
}
328

    
329
void op_sub (void)
330
{
331
    T0 = (int32_t)((int32_t)T0 - (int32_t)T1);
332
    RETURN();
333
}
334

    
335
void op_subo (void)
336
{
337
    target_ulong tmp;
338

    
339
    tmp = (int32_t)T0;
340
    T0 = (int32_t)T0 - (int32_t)T1;
341
    if (((tmp ^ T1) & (tmp ^ T0)) >> 31) {
342
        /* operands of different sign, first operand and result different sign */
343
        CALL_FROM_TB1(do_raise_exception, EXCP_OVERFLOW);
344
    }
345
    T0 = (int32_t)T0;
346
    RETURN();
347
}
348

    
349
void op_mul (void)
350
{
351
    T0 = (int32_t)((int32_t)T0 * (int32_t)T1);
352
    RETURN();
353
}
354

    
355
#if HOST_LONG_BITS < 64
356
void op_div (void)
357
{
358
    CALL_FROM_TB0(do_div);
359
    RETURN();
360
}
361
#else
362
void op_div (void)
363
{
364
    if (T1 != 0) {
365
        env->LO = (int32_t)((int64_t)(int32_t)T0 / (int32_t)T1);
366
        env->HI = (int32_t)((int64_t)(int32_t)T0 % (int32_t)T1);
367
    }
368
    RETURN();
369
}
370
#endif
371

    
372
void op_divu (void)
373
{
374
    if (T1 != 0) {
375
        env->LO = (int32_t)((uint32_t)T0 / (uint32_t)T1);
376
        env->HI = (int32_t)((uint32_t)T0 % (uint32_t)T1);
377
    }
378
    RETURN();
379
}
380

    
381
#ifdef TARGET_MIPS64
382
/* Arithmetic */
383
void op_dadd (void)
384
{
385
    T0 += T1;
386
    RETURN();
387
}
388

    
389
void op_daddo (void)
390
{
391
    target_long tmp;
392

    
393
    tmp = T0;
394
    T0 += T1;
395
    if (((tmp ^ T1 ^ (-1)) & (T0 ^ T1)) >> 63) {
396
        /* operands of same sign, result different sign */
397
        CALL_FROM_TB1(do_raise_exception, EXCP_OVERFLOW);
398
    }
399
    RETURN();
400
}
401

    
402
void op_dsub (void)
403
{
404
    T0 -= T1;
405
    RETURN();
406
}
407

    
408
void op_dsubo (void)
409
{
410
    target_long tmp;
411

    
412
    tmp = T0;
413
    T0 = (int64_t)T0 - (int64_t)T1;
414
    if (((tmp ^ T1) & (tmp ^ T0)) >> 63) {
415
        /* operands of different sign, first operand and result different sign */
416
        CALL_FROM_TB1(do_raise_exception, EXCP_OVERFLOW);
417
    }
418
    RETURN();
419
}
420

    
421
void op_dmul (void)
422
{
423
    T0 = (int64_t)T0 * (int64_t)T1;
424
    RETURN();
425
}
426

    
427
/* Those might call libgcc functions.  */
428
void op_ddiv (void)
429
{
430
    do_ddiv();
431
    RETURN();
432
}
433

    
434
#if TARGET_LONG_BITS > HOST_LONG_BITS
435
void op_ddivu (void)
436
{
437
    do_ddivu();
438
    RETURN();
439
}
440
#else
441
void op_ddivu (void)
442
{
443
    if (T1 != 0) {
444
        env->LO = T0 / T1;
445
        env->HI = T0 % T1;
446
    }
447
    RETURN();
448
}
449
#endif
450
#endif /* TARGET_MIPS64 */
451

    
452
/* Logical */
453
void op_and (void)
454
{
455
    T0 &= T1;
456
    RETURN();
457
}
458

    
459
void op_nor (void)
460
{
461
    T0 = ~(T0 | T1);
462
    RETURN();
463
}
464

    
465
void op_or (void)
466
{
467
    T0 |= T1;
468
    RETURN();
469
}
470

    
471
void op_xor (void)
472
{
473
    T0 ^= T1;
474
    RETURN();
475
}
476

    
477
void op_sll (void)
478
{
479
    T0 = (int32_t)((uint32_t)T0 << T1);
480
    RETURN();
481
}
482

    
483
void op_sra (void)
484
{
485
    T0 = (int32_t)((int32_t)T0 >> T1);
486
    RETURN();
487
}
488

    
489
void op_srl (void)
490
{
491
    T0 = (int32_t)((uint32_t)T0 >> T1);
492
    RETURN();
493
}
494

    
495
void op_rotr (void)
496
{
497
    target_ulong tmp;
498

    
499
    if (T1) {
500
       tmp = (int32_t)((uint32_t)T0 << (0x20 - T1));
501
       T0 = (int32_t)((uint32_t)T0 >> T1) | tmp;
502
    }
503
    RETURN();
504
}
505

    
506
void op_sllv (void)
507
{
508
    T0 = (int32_t)((uint32_t)T1 << ((uint32_t)T0 & 0x1F));
509
    RETURN();
510
}
511

    
512
void op_srav (void)
513
{
514
    T0 = (int32_t)((int32_t)T1 >> (T0 & 0x1F));
515
    RETURN();
516
}
517

    
518
void op_srlv (void)
519
{
520
    T0 = (int32_t)((uint32_t)T1 >> (T0 & 0x1F));
521
    RETURN();
522
}
523

    
524
void op_rotrv (void)
525
{
526
    target_ulong tmp;
527

    
528
    T0 &= 0x1F;
529
    if (T0) {
530
       tmp = (int32_t)((uint32_t)T1 << (0x20 - T0));
531
       T0 = (int32_t)((uint32_t)T1 >> T0) | tmp;
532
    } else
533
       T0 = T1;
534
    RETURN();
535
}
536

    
537
void op_clo (void)
538
{
539
    int n;
540

    
541
    if (T0 == ~((target_ulong)0)) {
542
        T0 = 32;
543
    } else {
544
        for (n = 0; n < 32; n++) {
545
            if (!(T0 & (1 << 31)))
546
                break;
547
            T0 = T0 << 1;
548
        }
549
        T0 = n;
550
    }
551
    RETURN();
552
}
553

    
554
void op_clz (void)
555
{
556
    int n;
557

    
558
    if (T0 == 0) {
559
        T0 = 32;
560
    } else {
561
        for (n = 0; n < 32; n++) {
562
            if (T0 & (1 << 31))
563
                break;
564
            T0 = T0 << 1;
565
        }
566
        T0 = n;
567
    }
568
    RETURN();
569
}
570

    
571
#ifdef TARGET_MIPS64
572

    
573
#if TARGET_LONG_BITS > HOST_LONG_BITS
574
/* Those might call libgcc functions.  */
575
void op_dsll (void)
576
{
577
    CALL_FROM_TB0(do_dsll);
578
    RETURN();
579
}
580

    
581
void op_dsll32 (void)
582
{
583
    CALL_FROM_TB0(do_dsll32);
584
    RETURN();
585
}
586

    
587
void op_dsra (void)
588
{
589
    CALL_FROM_TB0(do_dsra);
590
    RETURN();
591
}
592

    
593
void op_dsra32 (void)
594
{
595
    CALL_FROM_TB0(do_dsra32);
596
    RETURN();
597
}
598

    
599
void op_dsrl (void)
600
{
601
    CALL_FROM_TB0(do_dsrl);
602
    RETURN();
603
}
604

    
605
void op_dsrl32 (void)
606
{
607
    CALL_FROM_TB0(do_dsrl32);
608
    RETURN();
609
}
610

    
611
void op_drotr (void)
612
{
613
    CALL_FROM_TB0(do_drotr);
614
    RETURN();
615
}
616

    
617
void op_drotr32 (void)
618
{
619
    CALL_FROM_TB0(do_drotr32);
620
    RETURN();
621
}
622

    
623
void op_dsllv (void)
624
{
625
    CALL_FROM_TB0(do_dsllv);
626
    RETURN();
627
}
628

    
629
void op_dsrav (void)
630
{
631
    CALL_FROM_TB0(do_dsrav);
632
    RETURN();
633
}
634

    
635
void op_dsrlv (void)
636
{
637
    CALL_FROM_TB0(do_dsrlv);
638
    RETURN();
639
}
640

    
641
void op_drotrv (void)
642
{
643
    CALL_FROM_TB0(do_drotrv);
644
    RETURN();
645
}
646

    
647
#else /* TARGET_LONG_BITS > HOST_LONG_BITS */
648

    
649
void op_dsll (void)
650
{
651
    T0 = T0 << T1;
652
    RETURN();
653
}
654

    
655
void op_dsll32 (void)
656
{
657
    T0 = T0 << (T1 + 32);
658
    RETURN();
659
}
660

    
661
void op_dsra (void)
662
{
663
    T0 = (int64_t)T0 >> T1;
664
    RETURN();
665
}
666

    
667
void op_dsra32 (void)
668
{
669
    T0 = (int64_t)T0 >> (T1 + 32);
670
    RETURN();
671
}
672

    
673
void op_dsrl (void)
674
{
675
    T0 = T0 >> T1;
676
    RETURN();
677
}
678

    
679
void op_dsrl32 (void)
680
{
681
    T0 = T0 >> (T1 + 32);
682
    RETURN();
683
}
684

    
685
void op_drotr (void)
686
{
687
    target_ulong tmp;
688

    
689
    if (T1) {
690
       tmp = T0 << (0x40 - T1);
691
       T0 = (T0 >> T1) | tmp;
692
    }
693
    RETURN();
694
}
695

    
696
void op_drotr32 (void)
697
{
698
    target_ulong tmp;
699

    
700
    if (T1) {
701
       tmp = T0 << (0x40 - (32 + T1));
702
       T0 = (T0 >> (32 + T1)) | tmp;
703
    }
704
    RETURN();
705
}
706

    
707
void op_dsllv (void)
708
{
709
    T0 = T1 << (T0 & 0x3F);
710
    RETURN();
711
}
712

    
713
void op_dsrav (void)
714
{
715
    T0 = (int64_t)T1 >> (T0 & 0x3F);
716
    RETURN();
717
}
718

    
719
void op_dsrlv (void)
720
{
721
    T0 = T1 >> (T0 & 0x3F);
722
    RETURN();
723
}
724

    
725
void op_drotrv (void)
726
{
727
    target_ulong tmp;
728

    
729
    T0 &= 0x3F;
730
    if (T0) {
731
       tmp = T1 << (0x40 - T0);
732
       T0 = (T1 >> T0) | tmp;
733
    } else
734
       T0 = T1;
735
    RETURN();
736
}
737
#endif /* TARGET_LONG_BITS > HOST_LONG_BITS */
738

    
739
void op_dclo (void)
740
{
741
    int n;
742

    
743
    if (T0 == ~((target_ulong)0)) {
744
        T0 = 64;
745
    } else {
746
        for (n = 0; n < 64; n++) {
747
            if (!(T0 & (1ULL << 63)))
748
                break;
749
            T0 = T0 << 1;
750
        }
751
        T0 = n;
752
    }
753
    RETURN();
754
}
755

    
756
void op_dclz (void)
757
{
758
    int n;
759

    
760
    if (T0 == 0) {
761
        T0 = 64;
762
    } else {
763
        for (n = 0; n < 64; n++) {
764
            if (T0 & (1ULL << 63))
765
                break;
766
            T0 = T0 << 1;
767
        }
768
        T0 = n;
769
    }
770
    RETURN();
771
}
772
#endif
773

    
774
/* 64 bits arithmetic */
775
#if TARGET_LONG_BITS > HOST_LONG_BITS
776
void op_mult (void)
777
{
778
    CALL_FROM_TB0(do_mult);
779
    RETURN();
780
}
781

    
782
void op_multu (void)
783
{
784
    CALL_FROM_TB0(do_multu);
785
    RETURN();
786
}
787

    
788
void op_madd (void)
789
{
790
    CALL_FROM_TB0(do_madd);
791
    RETURN();
792
}
793

    
794
void op_maddu (void)
795
{
796
    CALL_FROM_TB0(do_maddu);
797
    RETURN();
798
}
799

    
800
void op_msub (void)
801
{
802
    CALL_FROM_TB0(do_msub);
803
    RETURN();
804
}
805

    
806
void op_msubu (void)
807
{
808
    CALL_FROM_TB0(do_msubu);
809
    RETURN();
810
}
811

    
812
#else /* TARGET_LONG_BITS > HOST_LONG_BITS */
813

    
814
static inline uint64_t get_HILO (void)
815
{
816
    return ((uint64_t)env->HI << 32) | ((uint64_t)(uint32_t)env->LO);
817
}
818

    
819
static inline void set_HILO (uint64_t HILO)
820
{
821
    env->LO = (int32_t)(HILO & 0xFFFFFFFF);
822
    env->HI = (int32_t)(HILO >> 32);
823
}
824

    
825
void op_mult (void)
826
{
827
    set_HILO((int64_t)(int32_t)T0 * (int64_t)(int32_t)T1);
828
    RETURN();
829
}
830

    
831
void op_multu (void)
832
{
833
    set_HILO((uint64_t)(uint32_t)T0 * (uint64_t)(uint32_t)T1);
834
    RETURN();
835
}
836

    
837
void op_madd (void)
838
{
839
    int64_t tmp;
840

    
841
    tmp = ((int64_t)(int32_t)T0 * (int64_t)(int32_t)T1);
842
    set_HILO((int64_t)get_HILO() + tmp);
843
    RETURN();
844
}
845

    
846
void op_maddu (void)
847
{
848
    uint64_t tmp;
849

    
850
    tmp = ((uint64_t)(uint32_t)T0 * (uint64_t)(uint32_t)T1);
851
    set_HILO(get_HILO() + tmp);
852
    RETURN();
853
}
854

    
855
void op_msub (void)
856
{
857
    int64_t tmp;
858

    
859
    tmp = ((int64_t)(int32_t)T0 * (int64_t)(int32_t)T1);
860
    set_HILO((int64_t)get_HILO() - tmp);
861
    RETURN();
862
}
863

    
864
void op_msubu (void)
865
{
866
    uint64_t tmp;
867

    
868
    tmp = ((uint64_t)(uint32_t)T0 * (uint64_t)(uint32_t)T1);
869
    set_HILO(get_HILO() - tmp);
870
    RETURN();
871
}
872
#endif /* TARGET_LONG_BITS > HOST_LONG_BITS */
873

    
874
#ifdef TARGET_MIPS64
875
void op_dmult (void)
876
{
877
    CALL_FROM_TB0(do_dmult);
878
    RETURN();
879
}
880

    
881
void op_dmultu (void)
882
{
883
    CALL_FROM_TB0(do_dmultu);
884
    RETURN();
885
}
886
#endif
887

    
888
/* Conditional moves */
889
void op_movn (void)
890
{
891
    if (T1 != 0)
892
        env->gpr[PARAM1] = T0;
893
    RETURN();
894
}
895

    
896
void op_movz (void)
897
{
898
    if (T1 == 0)
899
        env->gpr[PARAM1] = T0;
900
    RETURN();
901
}
902

    
903
void op_movf (void)
904
{
905
    if (!(env->fcr31 & PARAM1))
906
        T0 = T1;
907
    RETURN();
908
}
909

    
910
void op_movt (void)
911
{
912
    if (env->fcr31 & PARAM1)
913
        T0 = T1;
914
    RETURN();
915
}
916

    
917
/* Tests */
918
#define OP_COND(name, cond) \
919
void glue(op_, name) (void) \
920
{                           \
921
    if (cond) {             \
922
        T0 = 1;             \
923
    } else {                \
924
        T0 = 0;             \
925
    }                       \
926
    RETURN();               \
927
}
928

    
929
OP_COND(eq, T0 == T1);
930
OP_COND(ne, T0 != T1);
931
OP_COND(ge, (int32_t)T0 >= (int32_t)T1);
932
OP_COND(geu, T0 >= T1);
933
OP_COND(lt, (int32_t)T0 < (int32_t)T1);
934
OP_COND(ltu, T0 < T1);
935
OP_COND(gez, (int32_t)T0 >= 0);
936
OP_COND(gtz, (int32_t)T0 > 0);
937
OP_COND(lez, (int32_t)T0 <= 0);
938
OP_COND(ltz, (int32_t)T0 < 0);
939

    
940
/* Branches */
941
//#undef USE_DIRECT_JUMP
942

    
943
void OPPROTO op_goto_tb0(void)
944
{
945
    GOTO_TB(op_goto_tb0, PARAM1, 0);
946
    RETURN();
947
}
948

    
949
void OPPROTO op_goto_tb1(void)
950
{
951
    GOTO_TB(op_goto_tb1, PARAM1, 1);
952
    RETURN();
953
}
954

    
955
/* Branch to register */
956
void op_save_breg_target (void)
957
{
958
    env->btarget = T2;
959
    RETURN();
960
}
961

    
962
void op_restore_breg_target (void)
963
{
964
    T2 = env->btarget;
965
    RETURN();
966
}
967

    
968
void op_breg (void)
969
{
970
    env->PC = T2;
971
    RETURN();
972
}
973

    
974
void op_save_btarget (void)
975
{
976
    env->btarget = PARAM1;
977
    RETURN();
978
}
979

    
980
/* Conditional branch */
981
void op_set_bcond (void)
982
{
983
    T2 = T0;
984
    RETURN();
985
}
986

    
987
void op_save_bcond (void)
988
{
989
    env->bcond = T2;
990
    RETURN();
991
}
992

    
993
void op_restore_bcond (void)
994
{
995
    T2 = env->bcond;
996
    RETURN();
997
}
998

    
999
void op_jnz_T2 (void)
1000
{
1001
    if (T2)
1002
        GOTO_LABEL_PARAM(1);
1003
    RETURN();
1004
}
1005

    
1006
/* CP0 functions */
1007
void op_mfc0_index (void)
1008
{
1009
    T0 = env->CP0_Index;
1010
    RETURN();
1011
}
1012

    
1013
void op_mfc0_random (void)
1014
{
1015
    CALL_FROM_TB0(do_mfc0_random);
1016
    RETURN();
1017
}
1018

    
1019
void op_mfc0_entrylo0 (void)
1020
{
1021
    T0 = (int32_t)env->CP0_EntryLo0;
1022
    RETURN();
1023
}
1024

    
1025
void op_mfc0_entrylo1 (void)
1026
{
1027
    T0 = (int32_t)env->CP0_EntryLo1;
1028
    RETURN();
1029
}
1030

    
1031
void op_mfc0_context (void)
1032
{
1033
    T0 = (int32_t)env->CP0_Context;
1034
    RETURN();
1035
}
1036

    
1037
void op_mfc0_pagemask (void)
1038
{
1039
    T0 = env->CP0_PageMask;
1040
    RETURN();
1041
}
1042

    
1043
void op_mfc0_pagegrain (void)
1044
{
1045
    T0 = env->CP0_PageGrain;
1046
    RETURN();
1047
}
1048

    
1049
void op_mfc0_wired (void)
1050
{
1051
    T0 = env->CP0_Wired;
1052
    RETURN();
1053
}
1054

    
1055
void op_mfc0_hwrena (void)
1056
{
1057
    T0 = env->CP0_HWREna;
1058
    RETURN();
1059
}
1060

    
1061
void op_mfc0_badvaddr (void)
1062
{
1063
    T0 = (int32_t)env->CP0_BadVAddr;
1064
    RETURN();
1065
}
1066

    
1067
void op_mfc0_count (void)
1068
{
1069
    CALL_FROM_TB0(do_mfc0_count);
1070
    RETURN();
1071
}
1072

    
1073
void op_mfc0_entryhi (void)
1074
{
1075
    T0 = (int32_t)env->CP0_EntryHi;
1076
    RETURN();
1077
}
1078

    
1079
void op_mfc0_compare (void)
1080
{
1081
    T0 = env->CP0_Compare;
1082
    RETURN();
1083
}
1084

    
1085
void op_mfc0_status (void)
1086
{
1087
    T0 = env->CP0_Status;
1088
    RETURN();
1089
}
1090

    
1091
void op_mfc0_intctl (void)
1092
{
1093
    T0 = env->CP0_IntCtl;
1094
    RETURN();
1095
}
1096

    
1097
void op_mfc0_srsctl (void)
1098
{
1099
    T0 = env->CP0_SRSCtl;
1100
    RETURN();
1101
}
1102

    
1103
void op_mfc0_srsmap (void)
1104
{
1105
    T0 = env->CP0_SRSMap;
1106
    RETURN();
1107
}
1108

    
1109
void op_mfc0_cause (void)
1110
{
1111
    T0 = env->CP0_Cause;
1112
    RETURN();
1113
}
1114

    
1115
void op_mfc0_epc (void)
1116
{
1117
    T0 = (int32_t)env->CP0_EPC;
1118
    RETURN();
1119
}
1120

    
1121
void op_mfc0_prid (void)
1122
{
1123
    T0 = env->CP0_PRid;
1124
    RETURN();
1125
}
1126

    
1127
void op_mfc0_ebase (void)
1128
{
1129
    T0 = env->CP0_EBase;
1130
    RETURN();
1131
}
1132

    
1133
void op_mfc0_config0 (void)
1134
{
1135
    T0 = env->CP0_Config0;
1136
    RETURN();
1137
}
1138

    
1139
void op_mfc0_config1 (void)
1140
{
1141
    T0 = env->CP0_Config1;
1142
    RETURN();
1143
}
1144

    
1145
void op_mfc0_config2 (void)
1146
{
1147
    T0 = env->CP0_Config2;
1148
    RETURN();
1149
}
1150

    
1151
void op_mfc0_config3 (void)
1152
{
1153
    T0 = env->CP0_Config3;
1154
    RETURN();
1155
}
1156

    
1157
void op_mfc0_config6 (void)
1158
{
1159
    T0 = env->CP0_Config6;
1160
    RETURN();
1161
}
1162

    
1163
void op_mfc0_config7 (void)
1164
{
1165
    T0 = env->CP0_Config7;
1166
    RETURN();
1167
}
1168

    
1169
void op_mfc0_lladdr (void)
1170
{
1171
    T0 = (int32_t)env->CP0_LLAddr >> 4;
1172
    RETURN();
1173
}
1174

    
1175
void op_mfc0_watchlo0 (void)
1176
{
1177
    T0 = (int32_t)env->CP0_WatchLo;
1178
    RETURN();
1179
}
1180

    
1181
void op_mfc0_watchhi0 (void)
1182
{
1183
    T0 = env->CP0_WatchHi;
1184
    RETURN();
1185
}
1186

    
1187
void op_mfc0_xcontext (void)
1188
{
1189
    T0 = (int32_t)env->CP0_XContext;
1190
    RETURN();
1191
}
1192

    
1193
void op_mfc0_framemask (void)
1194
{
1195
    T0 = env->CP0_Framemask;
1196
    RETURN();
1197
}
1198

    
1199
void op_mfc0_debug (void)
1200
{
1201
    T0 = env->CP0_Debug;
1202
    if (env->hflags & MIPS_HFLAG_DM)
1203
        T0 |= 1 << CP0DB_DM;
1204
    RETURN();
1205
}
1206

    
1207
void op_mfc0_depc (void)
1208
{
1209
    T0 = (int32_t)env->CP0_DEPC;
1210
    RETURN();
1211
}
1212

    
1213
void op_mfc0_performance0 (void)
1214
{
1215
    T0 = env->CP0_Performance0;
1216
    RETURN();
1217
}
1218

    
1219
void op_mfc0_taglo (void)
1220
{
1221
    T0 = env->CP0_TagLo;
1222
    RETURN();
1223
}
1224

    
1225
void op_mfc0_datalo (void)
1226
{
1227
    T0 = env->CP0_DataLo;
1228
    RETURN();
1229
}
1230

    
1231
void op_mfc0_taghi (void)
1232
{
1233
    T0 = env->CP0_TagHi;
1234
    RETURN();
1235
}
1236

    
1237
void op_mfc0_datahi (void)
1238
{
1239
    T0 = env->CP0_DataHi;
1240
    RETURN();
1241
}
1242

    
1243
void op_mfc0_errorepc (void)
1244
{
1245
    T0 = (int32_t)env->CP0_ErrorEPC;
1246
    RETURN();
1247
}
1248

    
1249
void op_mfc0_desave (void)
1250
{
1251
    T0 = env->CP0_DESAVE;
1252
    RETURN();
1253
}
1254

    
1255
void op_mtc0_index (void)
1256
{
1257
    env->CP0_Index = (env->CP0_Index & 0x80000000) | (T0 % env->nb_tlb);
1258
    RETURN();
1259
}
1260

    
1261
void op_mtc0_entrylo0 (void)
1262
{
1263
    /* Large physaddr not implemented */
1264
    /* 1k pages not implemented */
1265
    env->CP0_EntryLo0 = (int32_t)T0 & 0x3FFFFFFF;
1266
    RETURN();
1267
}
1268

    
1269
void op_mtc0_entrylo1 (void)
1270
{
1271
    /* Large physaddr not implemented */
1272
    /* 1k pages not implemented */
1273
    env->CP0_EntryLo1 = (int32_t)T0 & 0x3FFFFFFF;
1274
    RETURN();
1275
}
1276

    
1277
void op_mtc0_context (void)
1278
{
1279
    env->CP0_Context = (env->CP0_Context & 0x007FFFFF) | (T0 & ~0x007FFFFF);
1280
    RETURN();
1281
}
1282

    
1283
void op_mtc0_pagemask (void)
1284
{
1285
    /* 1k pages not implemented */
1286
    env->CP0_PageMask = T0 & 0x1FFFE000;
1287
    RETURN();
1288
}
1289

    
1290
void op_mtc0_pagegrain (void)
1291
{
1292
    /* SmartMIPS not implemented */
1293
    /* Large physaddr not implemented */
1294
    /* 1k pages not implemented */
1295
    env->CP0_PageGrain = 0;
1296
    RETURN();
1297
}
1298

    
1299
void op_mtc0_wired (void)
1300
{
1301
    env->CP0_Wired = T0 % env->nb_tlb;
1302
    RETURN();
1303
}
1304

    
1305
void op_mtc0_hwrena (void)
1306
{
1307
    env->CP0_HWREna = T0 & 0x0000000F;
1308
    RETURN();
1309
}
1310

    
1311
void op_mtc0_count (void)
1312
{
1313
    CALL_FROM_TB2(cpu_mips_store_count, env, T0);
1314
    RETURN();
1315
}
1316

    
1317
void op_mtc0_entryhi (void)
1318
{
1319
    target_ulong old, val;
1320

    
1321
    /* 1k pages not implemented */
1322
    /* Ignore MIPS64 TLB for now */
1323
    val = (target_ulong)(int32_t)T0 & ~(target_ulong)0x1F00;
1324
    old = env->CP0_EntryHi;
1325
    env->CP0_EntryHi = val;
1326
    /* If the ASID changes, flush qemu's TLB.  */
1327
    if ((old & 0xFF) != (val & 0xFF))
1328
        CALL_FROM_TB2(cpu_mips_tlb_flush, env, 1);
1329
    RETURN();
1330
}
1331

    
1332
void op_mtc0_compare (void)
1333
{
1334
    CALL_FROM_TB2(cpu_mips_store_compare, env, T0);
1335
    RETURN();
1336
}
1337

    
1338
void op_mtc0_status (void)
1339
{
1340
    uint32_t val, old;
1341
    uint32_t mask = env->Status_rw_bitmask;
1342

    
1343
    /* No reverse endianness, no MDMX/DSP, no 64bit ops,
1344
       no 64bit addressing implemented. */
1345
    val = (int32_t)T0 & mask;
1346
    old = env->CP0_Status;
1347
    if (!(val & (1 << CP0St_EXL)) &&
1348
        !(val & (1 << CP0St_ERL)) &&
1349
        !(env->hflags & MIPS_HFLAG_DM) &&
1350
        (val & (1 << CP0St_UM)))
1351
        env->hflags |= MIPS_HFLAG_UM;
1352
    env->CP0_Status = (env->CP0_Status & ~mask) | val;
1353
    if (loglevel & CPU_LOG_EXEC)
1354
        CALL_FROM_TB2(do_mtc0_status_debug, old, val);
1355
    CALL_FROM_TB1(cpu_mips_update_irq, env);
1356
    RETURN();
1357
}
1358

    
1359
void op_mtc0_intctl (void)
1360
{
1361
    /* vectored interrupts not implemented, timer on int 7,
1362
       no performance counters. */
1363
    env->CP0_IntCtl |= T0 & 0x000002e0;
1364
    RETURN();
1365
}
1366

    
1367
void op_mtc0_srsctl (void)
1368
{
1369
    /* shadow registers not implemented */
1370
    env->CP0_SRSCtl = 0;
1371
    RETURN();
1372
}
1373

    
1374
void op_mtc0_srsmap (void)
1375
{
1376
    /* shadow registers not implemented */
1377
    env->CP0_SRSMap = 0;
1378
    RETURN();
1379
}
1380

    
1381
void op_mtc0_cause (void)
1382
{
1383
    uint32_t mask = 0x00C00300;
1384

    
1385
    if ((env->CP0_Config0 & (0x7 << CP0C0_AR)) == (1 << CP0C0_AR))
1386
        mask |= 1 << CP0Ca_DC;
1387

    
1388
    env->CP0_Cause = (env->CP0_Cause & ~mask) | (T0 & mask);
1389

    
1390
    /* Handle the software interrupt as an hardware one, as they
1391
       are very similar */
1392
    if (T0 & CP0Ca_IP_mask) {
1393
        CALL_FROM_TB1(cpu_mips_update_irq, env);
1394
    }
1395
    RETURN();
1396
}
1397

    
1398
void op_mtc0_epc (void)
1399
{
1400
    env->CP0_EPC = (int32_t)T0;
1401
    RETURN();
1402
}
1403

    
1404
void op_mtc0_ebase (void)
1405
{
1406
    /* vectored interrupts not implemented */
1407
    /* Multi-CPU not implemented */
1408
    env->CP0_EBase = 0x80000000 | (T0 & 0x3FFFF000);
1409
    RETURN();
1410
}
1411

    
1412
void op_mtc0_config0 (void)
1413
{
1414
#if defined(MIPS_USES_R4K_TLB)
1415
     /* Fixed mapping MMU not implemented */
1416
    env->CP0_Config0 = (env->CP0_Config0 & 0x8017FF88) | (T0 & 0x00000001);
1417
#else
1418
    env->CP0_Config0 = (env->CP0_Config0 & 0xFE17FF88) | (T0 & 0x00000001);
1419
#endif
1420
    RETURN();
1421
}
1422

    
1423
void op_mtc0_config2 (void)
1424
{
1425
    /* tertiary/secondary caches not implemented */
1426
    env->CP0_Config2 = (env->CP0_Config2 & 0x8FFF0FFF);
1427
    RETURN();
1428
}
1429

    
1430
void op_mtc0_watchlo0 (void)
1431
{
1432
    /* Watch exceptions for instructions, data loads, data stores
1433
       not implemented. */
1434
    env->CP0_WatchLo = (int32_t)(T0 & ~0x7);
1435
    RETURN();
1436
}
1437

    
1438
void op_mtc0_watchhi0 (void)
1439
{
1440
    env->CP0_WatchHi = (T0 & 0x40FF0FF8);
1441
    env->CP0_WatchHi &= ~(env->CP0_WatchHi & T0 & 0x7);
1442
    RETURN();
1443
}
1444

    
1445
void op_mtc0_framemask (void)
1446
{
1447
    env->CP0_Framemask = T0; /* XXX */
1448
    RETURN();
1449
}
1450

    
1451
void op_mtc0_debug (void)
1452
{
1453
    env->CP0_Debug = (env->CP0_Debug & 0x8C03FC1F) | (T0 & 0x13300120);
1454
    if (T0 & (1 << CP0DB_DM))
1455
        env->hflags |= MIPS_HFLAG_DM;
1456
    else
1457
        env->hflags &= ~MIPS_HFLAG_DM;
1458
    RETURN();
1459
}
1460

    
1461
void op_mtc0_depc (void)
1462
{
1463
    env->CP0_DEPC = (int32_t)T0;
1464
    RETURN();
1465
}
1466

    
1467
void op_mtc0_performance0 (void)
1468
{
1469
    env->CP0_Performance0 = T0; /* XXX */
1470
    RETURN();
1471
}
1472

    
1473
void op_mtc0_taglo (void)
1474
{
1475
    env->CP0_TagLo = T0 & 0xFFFFFCF6;
1476
    RETURN();
1477
}
1478

    
1479
void op_mtc0_datalo (void)
1480
{
1481
    env->CP0_DataLo = T0; /* XXX */
1482
    RETURN();
1483
}
1484

    
1485
void op_mtc0_taghi (void)
1486
{
1487
    env->CP0_TagHi = T0; /* XXX */
1488
    RETURN();
1489
}
1490

    
1491
void op_mtc0_datahi (void)
1492
{
1493
    env->CP0_DataHi = T0; /* XXX */
1494
    RETURN();
1495
}
1496

    
1497
void op_mtc0_errorepc (void)
1498
{
1499
    env->CP0_ErrorEPC = (int32_t)T0;
1500
    RETURN();
1501
}
1502

    
1503
void op_mtc0_desave (void)
1504
{
1505
    env->CP0_DESAVE = T0;
1506
    RETURN();
1507
}
1508

    
1509
#ifdef TARGET_MIPS64
1510
void op_dmfc0_entrylo0 (void)
1511
{
1512
    T0 = env->CP0_EntryLo0;
1513
    RETURN();
1514
}
1515

    
1516
void op_dmfc0_entrylo1 (void)
1517
{
1518
    T0 = env->CP0_EntryLo1;
1519
    RETURN();
1520
}
1521

    
1522
void op_dmfc0_context (void)
1523
{
1524
    T0 = env->CP0_Context;
1525
    RETURN();
1526
}
1527

    
1528
void op_dmfc0_badvaddr (void)
1529
{
1530
    T0 = env->CP0_BadVAddr;
1531
    RETURN();
1532
}
1533

    
1534
void op_dmfc0_entryhi (void)
1535
{
1536
    T0 = env->CP0_EntryHi;
1537
    RETURN();
1538
}
1539

    
1540
void op_dmfc0_epc (void)
1541
{
1542
    T0 = env->CP0_EPC;
1543
    RETURN();
1544
}
1545

    
1546
void op_dmfc0_lladdr (void)
1547
{
1548
    T0 = env->CP0_LLAddr >> 4;
1549
    RETURN();
1550
}
1551

    
1552
void op_dmfc0_watchlo0 (void)
1553
{
1554
    T0 = env->CP0_WatchLo;
1555
    RETURN();
1556
}
1557

    
1558
void op_dmfc0_xcontext (void)
1559
{
1560
    T0 = env->CP0_XContext;
1561
    RETURN();
1562
}
1563

    
1564
void op_dmfc0_depc (void)
1565
{
1566
    T0 = env->CP0_DEPC;
1567
    RETURN();
1568
}
1569

    
1570
void op_dmfc0_errorepc (void)
1571
{
1572
    T0 = env->CP0_ErrorEPC;
1573
    RETURN();
1574
}
1575

    
1576
void op_dmtc0_entrylo0 (void)
1577
{
1578
    /* Large physaddr not implemented */
1579
    /* 1k pages not implemented */
1580
    env->CP0_EntryLo0 = T0 & 0x3FFFFFFF;
1581
    RETURN();
1582
}
1583

    
1584
void op_dmtc0_entrylo1 (void)
1585
{
1586
    /* Large physaddr not implemented */
1587
    /* 1k pages not implemented */
1588
    env->CP0_EntryLo1 = T0 & 0x3FFFFFFF;
1589
    RETURN();
1590
}
1591

    
1592
void op_dmtc0_context (void)
1593
{
1594
    env->CP0_Context = (env->CP0_Context & 0x007FFFFF) | (T0 & ~0x007FFFFF);
1595
    RETURN();
1596
}
1597

    
1598
void op_dmtc0_epc (void)
1599
{
1600
    env->CP0_EPC = T0;
1601
    RETURN();
1602
}
1603

    
1604
void op_dmtc0_watchlo0 (void)
1605
{
1606
    /* Watch exceptions for instructions, data loads, data stores
1607
       not implemented. */
1608
    env->CP0_WatchLo = T0 & ~0x7;
1609
    RETURN();
1610
}
1611

    
1612
void op_dmtc0_xcontext (void)
1613
{
1614
    env->CP0_XContext = (env->CP0_XContext & 0xffffffff) | (T0 & ~0xffffffff);
1615
    RETURN();
1616
}
1617

    
1618
void op_dmtc0_depc (void)
1619
{
1620
    env->CP0_DEPC = T0;
1621
    RETURN();
1622
}
1623

    
1624
void op_dmtc0_errorepc (void)
1625
{
1626
    env->CP0_ErrorEPC = T0;
1627
    RETURN();
1628
}
1629
#endif /* TARGET_MIPS64 */
1630

    
1631
/* CP1 functions */
1632
#if 0
1633
# define DEBUG_FPU_STATE() CALL_FROM_TB1(dump_fpu, env)
1634
#else
1635
# define DEBUG_FPU_STATE() do { } while(0)
1636
#endif
1637

    
1638
void op_cp0_enabled(void)
1639
{
1640
    if (!(env->CP0_Status & (1 << CP0St_CU0)) &&
1641
        (env->hflags & MIPS_HFLAG_UM)) {
1642
        CALL_FROM_TB2(do_raise_exception_err, EXCP_CpU, 0);
1643
    }
1644
    RETURN();
1645
}
1646

    
1647
void op_cp1_enabled(void)
1648
{
1649
    if (!(env->CP0_Status & (1 << CP0St_CU1))) {
1650
        CALL_FROM_TB2(do_raise_exception_err, EXCP_CpU, 1);
1651
    }
1652
    RETURN();
1653
}
1654

    
1655
/* convert MIPS rounding mode in FCR31 to IEEE library */
1656
unsigned int ieee_rm[] = { 
1657
    float_round_nearest_even,
1658
    float_round_to_zero,
1659
    float_round_up,
1660
    float_round_down
1661
};
1662

    
1663
#define RESTORE_ROUNDING_MODE \
1664
    set_float_rounding_mode(ieee_rm[env->fcr31 & 3], &env->fp_status)
1665

    
1666
inline char ieee_ex_to_mips(char xcpt)
1667
{
1668
    return (xcpt & float_flag_inexact) >> 5 |
1669
           (xcpt & float_flag_underflow) >> 3 |
1670
           (xcpt & float_flag_overflow) >> 1 |
1671
           (xcpt & float_flag_divbyzero) << 1 |
1672
           (xcpt & float_flag_invalid) << 4;
1673
}
1674

    
1675
inline char mips_ex_to_ieee(char xcpt)
1676
{
1677
    return (xcpt & FP_INEXACT) << 5 |
1678
           (xcpt & FP_UNDERFLOW) << 3 |
1679
           (xcpt & FP_OVERFLOW) << 1 |
1680
           (xcpt & FP_DIV0) >> 1 |
1681
           (xcpt & FP_INVALID) >> 4;
1682
}
1683

    
1684
inline void update_fcr31(void)
1685
{
1686
    int tmp = ieee_ex_to_mips(get_float_exception_flags(&env->fp_status));
1687

    
1688
    SET_FP_CAUSE(env->fcr31, tmp);
1689
    if (GET_FP_ENABLE(env->fcr31) & tmp)
1690
        CALL_FROM_TB1(do_raise_exception, EXCP_FPE);
1691
    else
1692
        UPDATE_FP_FLAGS(env->fcr31, tmp);
1693
}
1694

    
1695

    
1696
void op_cfc1 (void)
1697
{
1698
    switch (T1) {
1699
    case 0:
1700
        T0 = (int32_t)env->fcr0;
1701
        break;
1702
    case 25:
1703
        T0 = ((env->fcr31 >> 24) & 0xfe) | ((env->fcr31 >> 23) & 0x1);
1704
        break;
1705
    case 26:
1706
        T0 = env->fcr31 & 0x0003f07c;
1707
        break;
1708
    case 28:
1709
        T0 = (env->fcr31 & 0x00000f83) | ((env->fcr31 >> 22) & 0x4);
1710
        break;
1711
    default:
1712
        T0 = (int32_t)env->fcr31;
1713
        break;
1714
    }
1715
    DEBUG_FPU_STATE();
1716
    RETURN();
1717
}
1718

    
1719
void op_ctc1 (void)
1720
{
1721
    switch(T1) {
1722
    case 25:
1723
        if (T0 & 0xffffff00)
1724
            goto leave;
1725
        env->fcr31 = (env->fcr31 & 0x017fffff) | ((T0 & 0xfe) << 24) |
1726
                     ((T0 & 0x1) << 23);
1727
        break;
1728
    case 26:
1729
        if (T0 & 0x007c0000)
1730
            goto leave;
1731
        env->fcr31 = (env->fcr31 & 0xfffc0f83) | (T0 & 0x0003f07c);
1732
        break;
1733
    case 28:
1734
        if (T0 & 0x007c0000)
1735
            goto leave;
1736
        env->fcr31 = (env->fcr31 & 0xfefff07c) | (T0 & 0x00000f83) |
1737
                     ((T0 & 0x4) << 22);
1738
        break;
1739
    case 31:
1740
        if (T0 & 0x007c0000)
1741
            goto leave;
1742
        env->fcr31 = T0;
1743
        break;
1744
    default:
1745
        goto leave;
1746
    }
1747
    /* set rounding mode */
1748
    RESTORE_ROUNDING_MODE;
1749
    set_float_exception_flags(0, &env->fp_status);
1750
    if ((GET_FP_ENABLE(env->fcr31) | 0x20) & GET_FP_CAUSE(env->fcr31))
1751
        CALL_FROM_TB1(do_raise_exception, EXCP_FPE);
1752
 leave:
1753
    DEBUG_FPU_STATE();
1754
    RETURN();
1755
}
1756

    
1757
void op_mfc1 (void)
1758
{
1759
    T0 = WT0;
1760
    DEBUG_FPU_STATE();
1761
    RETURN();
1762
}
1763

    
1764
void op_mtc1 (void)
1765
{
1766
    WT0 = T0;
1767
    DEBUG_FPU_STATE();
1768
    RETURN();
1769
}
1770

    
1771
void op_dmfc1 (void)
1772
{
1773
    T0 = DT0;
1774
    DEBUG_FPU_STATE();
1775
    RETURN();
1776
}
1777

    
1778
void op_dmtc1 (void)
1779
{
1780
    DT0 = T0;
1781
    DEBUG_FPU_STATE();
1782
    RETURN();
1783
}
1784

    
1785
void op_mfhc1 (void)
1786
{
1787
    T0 = WTH0;
1788
    DEBUG_FPU_STATE();
1789
    RETURN();
1790
}
1791

    
1792
void op_mthc1 (void)
1793
{
1794
    WTH0 = T0;
1795
    DEBUG_FPU_STATE();
1796
    RETURN();
1797
}
1798

    
1799
/* Float support.
1800
   Single precition routines have a "s" suffix, double precision a
1801
   "d" suffix, 32bit integer "w", 64bit integer "l", paired singe "ps",
1802
   paired single lowwer "pl", paired single upper "pu".  */
1803

    
1804
#define FLOAT_OP(name, p) void OPPROTO op_float_##name##_##p(void)
1805

    
1806
FLOAT_OP(cvtd, s)
1807
{
1808
    set_float_exception_flags(0, &env->fp_status);
1809
    FDT2 = float32_to_float64(FST0, &env->fp_status);
1810
    update_fcr31();
1811
    DEBUG_FPU_STATE();
1812
    RETURN();
1813
}
1814
FLOAT_OP(cvtd, w)
1815
{
1816
    set_float_exception_flags(0, &env->fp_status);
1817
    FDT2 = int32_to_float64(WT0, &env->fp_status);
1818
    update_fcr31();
1819
    DEBUG_FPU_STATE();
1820
    RETURN();
1821
}
1822
FLOAT_OP(cvtd, l)
1823
{
1824
    set_float_exception_flags(0, &env->fp_status);
1825
    FDT2 = int64_to_float64(DT0, &env->fp_status);
1826
    update_fcr31();
1827
    DEBUG_FPU_STATE();
1828
    RETURN();
1829
}
1830
FLOAT_OP(cvtl, d)
1831
{
1832
    set_float_exception_flags(0, &env->fp_status);
1833
    DT2 = float64_to_int64(FDT0, &env->fp_status);
1834
    update_fcr31();
1835
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
1836
        DT2 = 0x7fffffffffffffffULL;
1837
    DEBUG_FPU_STATE();
1838
    RETURN();
1839
}
1840
FLOAT_OP(cvtl, s)
1841
{
1842
    set_float_exception_flags(0, &env->fp_status);
1843
    DT2 = float32_to_int64(FST0, &env->fp_status);
1844
    update_fcr31();
1845
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
1846
        DT2 = 0x7fffffffffffffffULL;
1847
    DEBUG_FPU_STATE();
1848
    RETURN();
1849
}
1850
FLOAT_OP(cvtps, s)
1851
{
1852
    WT2 = WT0;
1853
    WTH2 = WT1;
1854
    DEBUG_FPU_STATE();
1855
    RETURN();
1856
}
1857
FLOAT_OP(cvtps, pw)
1858
{
1859
    set_float_exception_flags(0, &env->fp_status);
1860
    FST2 = int32_to_float32(WT0, &env->fp_status);
1861
    FSTH2 = int32_to_float32(WTH0, &env->fp_status);
1862
    update_fcr31();
1863
    DEBUG_FPU_STATE();
1864
    RETURN();
1865
}
1866
FLOAT_OP(cvtpw, ps)
1867
{
1868
    set_float_exception_flags(0, &env->fp_status);
1869
    WT2 = float32_to_int32(FST0, &env->fp_status);
1870
    WTH2 = float32_to_int32(FSTH0, &env->fp_status);
1871
    update_fcr31();
1872
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
1873
        WT2 = 0x7fffffff;
1874
    DEBUG_FPU_STATE();
1875
    RETURN();
1876
}
1877
FLOAT_OP(cvts, d)
1878
{
1879
    set_float_exception_flags(0, &env->fp_status);
1880
    FST2 = float64_to_float32(FDT0, &env->fp_status);
1881
    update_fcr31();
1882
    DEBUG_FPU_STATE();
1883
    RETURN();
1884
}
1885
FLOAT_OP(cvts, w)
1886
{
1887
    set_float_exception_flags(0, &env->fp_status);
1888
    FST2 = int32_to_float32(WT0, &env->fp_status);
1889
    update_fcr31();
1890
    DEBUG_FPU_STATE();
1891
    RETURN();
1892
}
1893
FLOAT_OP(cvts, l)
1894
{
1895
    set_float_exception_flags(0, &env->fp_status);
1896
    FST2 = int64_to_float32(DT0, &env->fp_status);
1897
    update_fcr31();
1898
    DEBUG_FPU_STATE();
1899
    RETURN();
1900
}
1901
FLOAT_OP(cvts, pl)
1902
{
1903
    set_float_exception_flags(0, &env->fp_status);
1904
    WT2 = WT0;
1905
    update_fcr31();
1906
    DEBUG_FPU_STATE();
1907
    RETURN();
1908
}
1909
FLOAT_OP(cvts, pu)
1910
{
1911
    set_float_exception_flags(0, &env->fp_status);
1912
    WT2 = WTH0;
1913
    update_fcr31();
1914
    DEBUG_FPU_STATE();
1915
    RETURN();
1916
}
1917
FLOAT_OP(cvtw, s)
1918
{
1919
    set_float_exception_flags(0, &env->fp_status);
1920
    WT2 = float32_to_int32(FST0, &env->fp_status);
1921
    update_fcr31();
1922
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
1923
        WT2 = 0x7fffffff;
1924
    DEBUG_FPU_STATE();
1925
    RETURN();
1926
}
1927
FLOAT_OP(cvtw, d)
1928
{
1929
    set_float_exception_flags(0, &env->fp_status);
1930
    WT2 = float64_to_int32(FDT0, &env->fp_status);
1931
    update_fcr31();
1932
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
1933
        WT2 = 0x7fffffff;
1934
    DEBUG_FPU_STATE();
1935
    RETURN();
1936
}
1937

    
1938
FLOAT_OP(pll, ps)
1939
{
1940
    DT2 = ((uint64_t)WT0 << 32) | WT1;
1941
    DEBUG_FPU_STATE();
1942
    RETURN();
1943
}
1944
FLOAT_OP(plu, ps)
1945
{
1946
    DT2 = ((uint64_t)WT0 << 32) | WTH1;
1947
    DEBUG_FPU_STATE();
1948
    RETURN();
1949
}
1950
FLOAT_OP(pul, ps)
1951
{
1952
    DT2 = ((uint64_t)WTH0 << 32) | WT1;
1953
    DEBUG_FPU_STATE();
1954
    RETURN();
1955
}
1956
FLOAT_OP(puu, ps)
1957
{
1958
    DT2 = ((uint64_t)WTH0 << 32) | WTH1;
1959
    DEBUG_FPU_STATE();
1960
    RETURN();
1961
}
1962

    
1963
FLOAT_OP(roundl, d)
1964
{
1965
    set_float_rounding_mode(float_round_nearest_even, &env->fp_status);
1966
    DT2 = float64_round_to_int(FDT0, &env->fp_status);
1967
    RESTORE_ROUNDING_MODE;
1968
    update_fcr31();
1969
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
1970
        DT2 = 0x7fffffffffffffffULL;
1971
    DEBUG_FPU_STATE();
1972
    RETURN();
1973
}
1974
FLOAT_OP(roundl, s)
1975
{
1976
    set_float_rounding_mode(float_round_nearest_even, &env->fp_status);
1977
    DT2 = float32_round_to_int(FST0, &env->fp_status);
1978
    RESTORE_ROUNDING_MODE;
1979
    update_fcr31();
1980
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
1981
        DT2 = 0x7fffffffffffffffULL;
1982
    DEBUG_FPU_STATE();
1983
    RETURN();
1984
}
1985
FLOAT_OP(roundw, d)
1986
{
1987
    set_float_rounding_mode(float_round_nearest_even, &env->fp_status);
1988
    WT2 = float64_round_to_int(FDT0, &env->fp_status);
1989
    RESTORE_ROUNDING_MODE;
1990
    update_fcr31();
1991
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
1992
        WT2 = 0x7fffffff;
1993
    DEBUG_FPU_STATE();
1994
    RETURN();
1995
}
1996
FLOAT_OP(roundw, s)
1997
{
1998
    set_float_rounding_mode(float_round_nearest_even, &env->fp_status);
1999
    WT2 = float32_round_to_int(FST0, &env->fp_status);
2000
    RESTORE_ROUNDING_MODE;
2001
    update_fcr31();
2002
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2003
        WT2 = 0x7fffffff;
2004
    DEBUG_FPU_STATE();
2005
    RETURN();
2006
}
2007

    
2008
FLOAT_OP(truncl, d)
2009
{
2010
    DT2 = float64_to_int64_round_to_zero(FDT0, &env->fp_status);
2011
    update_fcr31();
2012
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2013
        DT2 = 0x7fffffffffffffffULL;
2014
    DEBUG_FPU_STATE();
2015
    RETURN();
2016
}
2017
FLOAT_OP(truncl, s)
2018
{
2019
    DT2 = float32_to_int64_round_to_zero(FST0, &env->fp_status);
2020
    update_fcr31();
2021
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2022
        DT2 = 0x7fffffffffffffffULL;
2023
    DEBUG_FPU_STATE();
2024
    RETURN();
2025
}
2026
FLOAT_OP(truncw, d)
2027
{
2028
    WT2 = float64_to_int32_round_to_zero(FDT0, &env->fp_status);
2029
    update_fcr31();
2030
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2031
        WT2 = 0x7fffffff;
2032
    DEBUG_FPU_STATE();
2033
    RETURN();
2034
}
2035
FLOAT_OP(truncw, s)
2036
{
2037
    WT2 = float32_to_int32_round_to_zero(FST0, &env->fp_status);
2038
    update_fcr31();
2039
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2040
        WT2 = 0x7fffffff;
2041
    DEBUG_FPU_STATE();
2042
    RETURN();
2043
}
2044

    
2045
FLOAT_OP(ceill, d)
2046
{
2047
    set_float_rounding_mode(float_round_up, &env->fp_status);
2048
    DT2 = float64_round_to_int(FDT0, &env->fp_status);
2049
    RESTORE_ROUNDING_MODE;
2050
    update_fcr31();
2051
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2052
        DT2 = 0x7fffffffffffffffULL;
2053
    DEBUG_FPU_STATE();
2054
    RETURN();
2055
}
2056
FLOAT_OP(ceill, s)
2057
{
2058
    set_float_rounding_mode(float_round_up, &env->fp_status);
2059
    DT2 = float32_round_to_int(FST0, &env->fp_status);
2060
    RESTORE_ROUNDING_MODE;
2061
    update_fcr31();
2062
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2063
        DT2 = 0x7fffffffffffffffULL;
2064
    DEBUG_FPU_STATE();
2065
    RETURN();
2066
}
2067
FLOAT_OP(ceilw, d)
2068
{
2069
    set_float_rounding_mode(float_round_up, &env->fp_status);
2070
    WT2 = float64_round_to_int(FDT0, &env->fp_status);
2071
    RESTORE_ROUNDING_MODE;
2072
    update_fcr31();
2073
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2074
        WT2 = 0x7fffffff;
2075
    DEBUG_FPU_STATE();
2076
    RETURN();
2077
}
2078
FLOAT_OP(ceilw, s)
2079
{
2080
    set_float_rounding_mode(float_round_up, &env->fp_status);
2081
    WT2 = float32_round_to_int(FST0, &env->fp_status);
2082
    RESTORE_ROUNDING_MODE;
2083
    update_fcr31();
2084
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2085
        WT2 = 0x7fffffff;
2086
    DEBUG_FPU_STATE();
2087
    RETURN();
2088
}
2089

    
2090
FLOAT_OP(floorl, d)
2091
{
2092
    set_float_rounding_mode(float_round_down, &env->fp_status);
2093
    DT2 = float64_round_to_int(FDT0, &env->fp_status);
2094
    RESTORE_ROUNDING_MODE;
2095
    update_fcr31();
2096
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2097
        DT2 = 0x7fffffffffffffffULL;
2098
    DEBUG_FPU_STATE();
2099
    RETURN();
2100
}
2101
FLOAT_OP(floorl, s)
2102
{
2103
    set_float_rounding_mode(float_round_down, &env->fp_status);
2104
    DT2 = float32_round_to_int(FST0, &env->fp_status);
2105
    RESTORE_ROUNDING_MODE;
2106
    update_fcr31();
2107
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2108
        DT2 = 0x7fffffffffffffffULL;
2109
    DEBUG_FPU_STATE();
2110
    RETURN();
2111
}
2112
FLOAT_OP(floorw, d)
2113
{
2114
    set_float_rounding_mode(float_round_down, &env->fp_status);
2115
    WT2 = float64_round_to_int(FDT0, &env->fp_status);
2116
    RESTORE_ROUNDING_MODE;
2117
    update_fcr31();
2118
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2119
        WT2 = 0x7fffffff;
2120
    DEBUG_FPU_STATE();
2121
    RETURN();
2122
}
2123
FLOAT_OP(floorw, s)
2124
{
2125
    set_float_rounding_mode(float_round_down, &env->fp_status);
2126
    WT2 = float32_round_to_int(FST0, &env->fp_status);
2127
    RESTORE_ROUNDING_MODE;
2128
    update_fcr31();
2129
    if (GET_FP_CAUSE(env->fcr31) & (FP_OVERFLOW | FP_INVALID))
2130
        WT2 = 0x7fffffff;
2131
    DEBUG_FPU_STATE();
2132
    RETURN();
2133
}
2134

    
2135
FLOAT_OP(movf, d)
2136
{
2137
    if (!(env->fcr31 & PARAM1))
2138
        DT2 = DT0;
2139
    DEBUG_FPU_STATE();
2140
    RETURN();
2141
}
2142
FLOAT_OP(movf, s)
2143
{
2144
    if (!(env->fcr31 & PARAM1))
2145
        WT2 = WT0;
2146
    DEBUG_FPU_STATE();
2147
    RETURN();
2148
}
2149
FLOAT_OP(movf, ps)
2150
{
2151
    if (!(env->fcr31 & PARAM1)) {
2152
        WT2 = WT0;
2153
        WTH2 = WTH0;
2154
    }
2155
    DEBUG_FPU_STATE();
2156
    RETURN();
2157
}
2158
FLOAT_OP(movt, d)
2159
{
2160
    if (env->fcr31 & PARAM1)
2161
        DT2 = DT0;
2162
    DEBUG_FPU_STATE();
2163
    RETURN();
2164
}
2165
FLOAT_OP(movt, s)
2166
{
2167
    if (env->fcr31 & PARAM1)
2168
        WT2 = WT0;
2169
    DEBUG_FPU_STATE();
2170
    RETURN();
2171
}
2172
FLOAT_OP(movt, ps)
2173
{
2174
    if (env->fcr31 & PARAM1) {
2175
        WT2 = WT0;
2176
        WTH2 = WTH0;
2177
    }
2178
    DEBUG_FPU_STATE();
2179
    RETURN();
2180
}
2181
FLOAT_OP(movz, d)
2182
{
2183
    if (!T0)
2184
        DT2 = DT0;
2185
    DEBUG_FPU_STATE();
2186
    RETURN();
2187
}
2188
FLOAT_OP(movz, s)
2189
{
2190
    if (!T0)
2191
        WT2 = WT0;
2192
    DEBUG_FPU_STATE();
2193
    RETURN();
2194
}
2195
FLOAT_OP(movz, ps)
2196
{
2197
    if (!T0) {
2198
        WT2 = WT0;
2199
        WTH2 = WTH0;
2200
    }
2201
    DEBUG_FPU_STATE();
2202
    RETURN();
2203
}
2204
FLOAT_OP(movn, d)
2205
{
2206
    if (T0)
2207
        DT2 = DT0;
2208
    DEBUG_FPU_STATE();
2209
    RETURN();
2210
}
2211
FLOAT_OP(movn, s)
2212
{
2213
    if (T0)
2214
        WT2 = WT0;
2215
    DEBUG_FPU_STATE();
2216
    RETURN();
2217
}
2218
FLOAT_OP(movn, ps)
2219
{
2220
    if (T0) {
2221
        WT2 = WT0;
2222
        WTH2 = WTH0;
2223
    }
2224
    DEBUG_FPU_STATE();
2225
    RETURN();
2226
}
2227

    
2228
/* binary operations */
2229
#define FLOAT_BINOP(name) \
2230
FLOAT_OP(name, d)         \
2231
{                         \
2232
    set_float_exception_flags(0, &env->fp_status);            \
2233
    FDT2 = float64_ ## name (FDT0, FDT1, &env->fp_status);    \
2234
    update_fcr31();       \
2235
    DEBUG_FPU_STATE();    \
2236
    RETURN();             \
2237
}                         \
2238
FLOAT_OP(name, s)         \
2239
{                         \
2240
    set_float_exception_flags(0, &env->fp_status);            \
2241
    FST2 = float32_ ## name (FST0, FST1, &env->fp_status);    \
2242
    update_fcr31();       \
2243
    DEBUG_FPU_STATE();    \
2244
    RETURN();             \
2245
}                         \
2246
FLOAT_OP(name, ps)        \
2247
{                         \
2248
    set_float_exception_flags(0, &env->fp_status);            \
2249
    FST2 = float32_ ## name (FST0, FST1, &env->fp_status);    \
2250
    FSTH2 = float32_ ## name (FSTH0, FSTH1, &env->fp_status); \
2251
    update_fcr31();       \
2252
    DEBUG_FPU_STATE();    \
2253
    RETURN();             \
2254
}
2255
FLOAT_BINOP(add)
2256
FLOAT_BINOP(sub)
2257
FLOAT_BINOP(mul)
2258
FLOAT_BINOP(div)
2259
#undef FLOAT_BINOP
2260

    
2261
FLOAT_OP(addr, ps)
2262
{
2263
    set_float_exception_flags(0, &env->fp_status);
2264
    FST2 = float32_add (FST0, FSTH0, &env->fp_status);
2265
    FSTH2 = float32_add (FST1, FSTH1, &env->fp_status);
2266
    update_fcr31();
2267
    DEBUG_FPU_STATE();
2268
    RETURN();
2269
}
2270

    
2271
/* ternary operations */
2272
#define FLOAT_TERNOP(name1, name2) \
2273
FLOAT_OP(name1 ## name2, d)        \
2274
{                                  \
2275
    FDT0 = float64_ ## name1 (FDT0, FDT1, &env->fp_status);    \
2276
    FDT2 = float64_ ## name2 (FDT0, FDT2, &env->fp_status);    \
2277
    DEBUG_FPU_STATE();             \
2278
    RETURN();                      \
2279
}                                  \
2280
FLOAT_OP(name1 ## name2, s)        \
2281
{                                  \
2282
    FST0 = float32_ ## name1 (FST0, FST1, &env->fp_status);    \
2283
    FST2 = float32_ ## name2 (FST0, FST2, &env->fp_status);    \
2284
    DEBUG_FPU_STATE();             \
2285
    RETURN();                      \
2286
}                                  \
2287
FLOAT_OP(name1 ## name2, ps)       \
2288
{                                  \
2289
    FST0 = float32_ ## name1 (FST0, FST1, &env->fp_status);    \
2290
    FSTH0 = float32_ ## name1 (FSTH0, FSTH1, &env->fp_status); \
2291
    FST2 = float32_ ## name2 (FST0, FST2, &env->fp_status);    \
2292
    FSTH2 = float32_ ## name2 (FSTH0, FSTH2, &env->fp_status); \
2293
    DEBUG_FPU_STATE();             \
2294
    RETURN();                      \
2295
}
2296
FLOAT_TERNOP(mul, add)
2297
FLOAT_TERNOP(mul, sub)
2298
#undef FLOAT_TERNOP
2299

    
2300
/* negated ternary operations */
2301
#define FLOAT_NTERNOP(name1, name2) \
2302
FLOAT_OP(n ## name1 ## name2, d)    \
2303
{                                   \
2304
    FDT0 = float64_ ## name1 (FDT0, FDT1, &env->fp_status);    \
2305
    FDT2 = float64_ ## name2 (FDT0, FDT2, &env->fp_status);    \
2306
    FDT2 ^= 1ULL << 63;             \
2307
    DEBUG_FPU_STATE();              \
2308
    RETURN();                       \
2309
}                                   \
2310
FLOAT_OP(n ## name1 ## name2, s)    \
2311
{                                   \
2312
    FST0 = float32_ ## name1 (FST0, FST1, &env->fp_status);    \
2313
    FST2 = float32_ ## name2 (FST0, FST2, &env->fp_status);    \
2314
    FST2 ^= 1 << 31;                \
2315
    DEBUG_FPU_STATE();              \
2316
    RETURN();                       \
2317
}                                   \
2318
FLOAT_OP(n ## name1 ## name2, ps)   \
2319
{                                   \
2320
    FST0 = float32_ ## name1 (FST0, FST1, &env->fp_status);    \
2321
    FSTH0 = float32_ ## name1 (FSTH0, FSTH1, &env->fp_status); \
2322
    FST2 = float32_ ## name2 (FST0, FST2, &env->fp_status);    \
2323
    FSTH2 = float32_ ## name2 (FSTH0, FSTH2, &env->fp_status); \
2324
    FST2 ^= 1 << 31;                \
2325
    FSTH2 ^= 1 << 31;               \
2326
    DEBUG_FPU_STATE();              \
2327
    RETURN();                       \
2328
}
2329
FLOAT_NTERNOP(mul, add)
2330
FLOAT_NTERNOP(mul, sub)
2331
#undef FLOAT_NTERNOP
2332

    
2333
/* unary operations, modifying fp status  */
2334
#define FLOAT_UNOP(name)  \
2335
FLOAT_OP(name, d)         \
2336
{                         \
2337
    FDT2 = float64_ ## name(FDT0, &env->fp_status);   \
2338
    DEBUG_FPU_STATE();    \
2339
    RETURN();                      \
2340
}                         \
2341
FLOAT_OP(name, s)         \
2342
{                         \
2343
    FST2 = float32_ ## name(FST0, &env->fp_status);   \
2344
    DEBUG_FPU_STATE();    \
2345
    RETURN();                      \
2346
}                         \
2347
FLOAT_OP(name, ps)        \
2348
{                         \
2349
    FST2 = float32_ ## name(FST0, &env->fp_status);   \
2350
    FSTH2 = float32_ ## name(FSTH0, &env->fp_status); \
2351
    DEBUG_FPU_STATE();    \
2352
    RETURN();                      \
2353
}
2354
FLOAT_UNOP(sqrt)
2355
#undef FLOAT_UNOP
2356

    
2357
/* unary operations, not modifying fp status  */
2358
#define FLOAT_UNOP(name)  \
2359
FLOAT_OP(name, d)         \
2360
{                         \
2361
    FDT2 = float64_ ## name(FDT0);   \
2362
    DEBUG_FPU_STATE();    \
2363
    RETURN();             \
2364
}                         \
2365
FLOAT_OP(name, s)         \
2366
{                         \
2367
    FST2 = float32_ ## name(FST0);   \
2368
    DEBUG_FPU_STATE();    \
2369
    RETURN();             \
2370
}                         \
2371
FLOAT_OP(name, ps)        \
2372
{                         \
2373
    FST2 = float32_ ## name(FST0);   \
2374
    FSTH2 = float32_ ## name(FSTH0); \
2375
    DEBUG_FPU_STATE();    \
2376
    RETURN();             \
2377
}
2378
FLOAT_UNOP(abs)
2379
FLOAT_UNOP(chs)
2380
#undef FLOAT_UNOP
2381

    
2382
FLOAT_OP(mov, d)
2383
{
2384
    FDT2 = FDT0;
2385
    DEBUG_FPU_STATE();
2386
    RETURN();
2387
}
2388
FLOAT_OP(mov, s)
2389
{
2390
    FST2 = FST0;
2391
    DEBUG_FPU_STATE();
2392
    RETURN();
2393
}
2394
FLOAT_OP(mov, ps)
2395
{
2396
    FST2 = FST0;
2397
    FSTH2 = FSTH0;
2398
    DEBUG_FPU_STATE();
2399
    RETURN();
2400
}
2401
FLOAT_OP(alnv, ps)
2402
{
2403
    switch (T0 & 0x7) {
2404
    case 0:
2405
        FST2 = FST0;
2406
        FSTH2 = FSTH0;
2407
        break;
2408
    case 4:
2409
#ifdef TARGET_WORDS_BIGENDIAN
2410
        FSTH2 = FST0;
2411
        FST2 = FSTH1;
2412
#else
2413
        FSTH2 = FST1;
2414
        FST2 = FSTH0;
2415
#endif
2416
        break;
2417
    default: /* unpredictable */
2418
        break;
2419
    }
2420
    DEBUG_FPU_STATE();
2421
    RETURN();
2422
}
2423

    
2424
#ifdef CONFIG_SOFTFLOAT
2425
#define clear_invalid() do {                                \
2426
    int flags = get_float_exception_flags(&env->fp_status); \
2427
    flags &= ~float_flag_invalid;                           \
2428
    set_float_exception_flags(flags, &env->fp_status);      \
2429
} while(0)
2430
#else
2431
#define clear_invalid() do { } while(0)
2432
#endif
2433

    
2434
extern void dump_fpu_s(CPUState *env);
2435

    
2436
#define FOP_COND_D(op, cond)                   \
2437
void op_cmp_d_ ## op (void)                    \
2438
{                                              \
2439
    int c = cond;                              \
2440
    update_fcr31();                            \
2441
    if (c)                                     \
2442
        SET_FP_COND(PARAM1, env);              \
2443
    else                                       \
2444
        CLEAR_FP_COND(PARAM1, env);            \
2445
    DEBUG_FPU_STATE();                         \
2446
    RETURN();                                  \
2447
}                                              \
2448
void op_cmpabs_d_ ## op (void)                 \
2449
{                                              \
2450
    int c;                                     \
2451
    FDT0 &= ~(1ULL << 63);                     \
2452
    FDT1 &= ~(1ULL << 63);                     \
2453
    c = cond;                                  \
2454
    update_fcr31();                            \
2455
    if (c)                                     \
2456
        SET_FP_COND(PARAM1, env);              \
2457
    else                                       \
2458
        CLEAR_FP_COND(PARAM1, env);            \
2459
    DEBUG_FPU_STATE();                         \
2460
    RETURN();                                  \
2461
}
2462

    
2463
int float64_is_unordered(int sig, float64 a, float64 b STATUS_PARAM)
2464
{
2465
    if (float64_is_signaling_nan(a) ||
2466
        float64_is_signaling_nan(b) ||
2467
        (sig && (float64_is_nan(a) || float64_is_nan(b)))) {
2468
        float_raise(float_flag_invalid, status);
2469
        return 1;
2470
    } else if (float64_is_nan(a) || float64_is_nan(b)) {
2471
        return 1;
2472
    } else {
2473
        return 0;
2474
    }
2475
}
2476

    
2477
/* NOTE: the comma operator will make "cond" to eval to false,
2478
 * but float*_is_unordered() is still called. */
2479
FOP_COND_D(f,   (float64_is_unordered(0, FDT1, FDT0, &env->fp_status), 0))
2480
FOP_COND_D(un,  float64_is_unordered(0, FDT1, FDT0, &env->fp_status))
2481
FOP_COND_D(eq,  !float64_is_unordered(0, FDT1, FDT0, &env->fp_status) && float64_eq(FDT0, FDT1, &env->fp_status))
2482
FOP_COND_D(ueq, float64_is_unordered(0, FDT1, FDT0, &env->fp_status)  || float64_eq(FDT0, FDT1, &env->fp_status))
2483
FOP_COND_D(olt, !float64_is_unordered(0, FDT1, FDT0, &env->fp_status) && float64_lt(FDT0, FDT1, &env->fp_status))
2484
FOP_COND_D(ult, float64_is_unordered(0, FDT1, FDT0, &env->fp_status)  || float64_lt(FDT0, FDT1, &env->fp_status))
2485
FOP_COND_D(ole, !float64_is_unordered(0, FDT1, FDT0, &env->fp_status) && float64_le(FDT0, FDT1, &env->fp_status))
2486
FOP_COND_D(ule, float64_is_unordered(0, FDT1, FDT0, &env->fp_status)  || float64_le(FDT0, FDT1, &env->fp_status))
2487
/* NOTE: the comma operator will make "cond" to eval to false,
2488
 * but float*_is_unordered() is still called. */
2489
FOP_COND_D(sf,  (float64_is_unordered(1, FDT1, FDT0, &env->fp_status), 0))
2490
FOP_COND_D(ngle,float64_is_unordered(1, FDT1, FDT0, &env->fp_status))
2491
FOP_COND_D(seq, !float64_is_unordered(1, FDT1, FDT0, &env->fp_status) && float64_eq(FDT0, FDT1, &env->fp_status))
2492
FOP_COND_D(ngl, float64_is_unordered(1, FDT1, FDT0, &env->fp_status)  || float64_eq(FDT0, FDT1, &env->fp_status))
2493
FOP_COND_D(lt,  !float64_is_unordered(1, FDT1, FDT0, &env->fp_status) && float64_lt(FDT0, FDT1, &env->fp_status))
2494
FOP_COND_D(nge, float64_is_unordered(1, FDT1, FDT0, &env->fp_status)  || float64_lt(FDT0, FDT1, &env->fp_status))
2495
FOP_COND_D(le,  !float64_is_unordered(1, FDT1, FDT0, &env->fp_status) && float64_le(FDT0, FDT1, &env->fp_status))
2496
FOP_COND_D(ngt, float64_is_unordered(1, FDT1, FDT0, &env->fp_status)  || float64_le(FDT0, FDT1, &env->fp_status))
2497

    
2498
#define FOP_COND_S(op, cond)                   \
2499
void op_cmp_s_ ## op (void)                    \
2500
{                                              \
2501
    int c = cond;                              \
2502
    update_fcr31();                            \
2503
    if (c)                                     \
2504
        SET_FP_COND(PARAM1, env);              \
2505
    else                                       \
2506
        CLEAR_FP_COND(PARAM1, env);            \
2507
    DEBUG_FPU_STATE();                         \
2508
    RETURN();                                  \
2509
}                                              \
2510
void op_cmpabs_s_ ## op (void)                 \
2511
{                                              \
2512
    int c;                                     \
2513
    FST0 &= ~(1 << 31);                        \
2514
    FST1 &= ~(1 << 31);                        \
2515
    c = cond;                                  \
2516
    update_fcr31();                            \
2517
    if (c)                                     \
2518
        SET_FP_COND(PARAM1, env);              \
2519
    else                                       \
2520
        CLEAR_FP_COND(PARAM1, env);            \
2521
    DEBUG_FPU_STATE();                         \
2522
    RETURN();                                  \
2523
}
2524

    
2525
flag float32_is_unordered(int sig, float32 a, float32 b STATUS_PARAM)
2526
{
2527
    extern flag float32_is_nan(float32 a);
2528
    if (float32_is_signaling_nan(a) ||
2529
        float32_is_signaling_nan(b) ||
2530
        (sig && (float32_is_nan(a) || float32_is_nan(b)))) {
2531
        float_raise(float_flag_invalid, status);
2532
        return 1;
2533
    } else if (float32_is_nan(a) || float32_is_nan(b)) {
2534
        return 1;
2535
    } else {
2536
        return 0;
2537
    }
2538
}
2539

    
2540
/* NOTE: the comma operator will make "cond" to eval to false,
2541
 * but float*_is_unordered() is still called. */
2542
FOP_COND_S(f,   (float32_is_unordered(0, FST1, FST0, &env->fp_status), 0))
2543
FOP_COND_S(un,  float32_is_unordered(0, FST1, FST0, &env->fp_status))
2544
FOP_COND_S(eq,  !float32_is_unordered(0, FST1, FST0, &env->fp_status) && float32_eq(FST0, FST1, &env->fp_status))
2545
FOP_COND_S(ueq, float32_is_unordered(0, FST1, FST0, &env->fp_status)  || float32_eq(FST0, FST1, &env->fp_status))
2546
FOP_COND_S(olt, !float32_is_unordered(0, FST1, FST0, &env->fp_status) && float32_lt(FST0, FST1, &env->fp_status))
2547
FOP_COND_S(ult, float32_is_unordered(0, FST1, FST0, &env->fp_status)  || float32_lt(FST0, FST1, &env->fp_status))
2548
FOP_COND_S(ole, !float32_is_unordered(0, FST1, FST0, &env->fp_status) && float32_le(FST0, FST1, &env->fp_status))
2549
FOP_COND_S(ule, float32_is_unordered(0, FST1, FST0, &env->fp_status)  || float32_le(FST0, FST1, &env->fp_status))
2550
/* NOTE: the comma operator will make "cond" to eval to false,
2551
 * but float*_is_unordered() is still called. */
2552
FOP_COND_S(sf,  (float32_is_unordered(1, FST1, FST0, &env->fp_status), 0))
2553
FOP_COND_S(ngle,float32_is_unordered(1, FST1, FST0, &env->fp_status))
2554
FOP_COND_S(seq, !float32_is_unordered(1, FST1, FST0, &env->fp_status) && float32_eq(FST0, FST1, &env->fp_status))
2555
FOP_COND_S(ngl, float32_is_unordered(1, FST1, FST0, &env->fp_status)  || float32_eq(FST0, FST1, &env->fp_status))
2556
FOP_COND_S(lt,  !float32_is_unordered(1, FST1, FST0, &env->fp_status) && float32_lt(FST0, FST1, &env->fp_status))
2557
FOP_COND_S(nge, float32_is_unordered(1, FST1, FST0, &env->fp_status)  || float32_lt(FST0, FST1, &env->fp_status))
2558
FOP_COND_S(le,  !float32_is_unordered(1, FST1, FST0, &env->fp_status) && float32_le(FST0, FST1, &env->fp_status))
2559
FOP_COND_S(ngt, float32_is_unordered(1, FST1, FST0, &env->fp_status)  || float32_le(FST0, FST1, &env->fp_status))
2560

    
2561
#define FOP_COND_PS(op, condl, condh)          \
2562
void op_cmp_ps_ ## op (void)                   \
2563
{                                              \
2564
    int cl = condl;                            \
2565
    int ch = condh;                            \
2566
    update_fcr31();                            \
2567
    if (cl)                                    \
2568
        SET_FP_COND(PARAM1, env);              \
2569
    else                                       \
2570
        CLEAR_FP_COND(PARAM1, env);            \
2571
    if (ch)                                    \
2572
        SET_FP_COND(PARAM1 + 1, env);          \
2573
    else                                       \
2574
        CLEAR_FP_COND(PARAM1 + 1, env);        \
2575
    DEBUG_FPU_STATE();                         \
2576
    RETURN();                                  \
2577
}                                              \
2578
void op_cmpabs_ps_ ## op (void)                \
2579
{                                              \
2580
    int cl, ch;                                \
2581
    FST0 &= ~(1 << 31);                        \
2582
    FSTH0 &= ~(1 << 31);                       \
2583
    FST1 &= ~(1 << 31);                        \
2584
    FSTH1 &= ~(1 << 31);                       \
2585
    cl = condl;                                \
2586
    ch = condh;                                \
2587
    update_fcr31();                            \
2588
    if (cl)                                    \
2589
        SET_FP_COND(PARAM1, env);              \
2590
    else                                       \
2591
        CLEAR_FP_COND(PARAM1, env);            \
2592
    if (ch)                                    \
2593
        SET_FP_COND(PARAM1 + 1, env);          \
2594
    else                                       \
2595
        CLEAR_FP_COND(PARAM1 + 1, env);        \
2596
    DEBUG_FPU_STATE();                         \
2597
    RETURN();                                  \
2598
}
2599

    
2600
/* NOTE: the comma operator will make "cond" to eval to false,
2601
 * but float*_is_unordered() is still called. */
2602
FOP_COND_PS(f,   (float32_is_unordered(0, FST1, FST0, &env->fp_status), 0),
2603
                 (float32_is_unordered(0, FSTH1, FSTH0, &env->fp_status), 0))
2604
FOP_COND_PS(un,  float32_is_unordered(0, FST1, FST0, &env->fp_status),
2605
                 float32_is_unordered(0, FSTH1, FSTH0, &env->fp_status))
2606
FOP_COND_PS(eq,  !float32_is_unordered(0, FST1, FST0, &env->fp_status)   && float32_eq(FST0, FST1, &env->fp_status),
2607
                 !float32_is_unordered(0, FSTH1, FSTH0, &env->fp_status) && float32_eq(FSTH0, FSTH1, &env->fp_status))
2608
FOP_COND_PS(ueq, float32_is_unordered(0, FST1, FST0, &env->fp_status)    || float32_eq(FST0, FST1, &env->fp_status),
2609
                 float32_is_unordered(0, FSTH1, FSTH0, &env->fp_status)  || float32_eq(FSTH0, FSTH1, &env->fp_status))
2610
FOP_COND_PS(olt, !float32_is_unordered(0, FST1, FST0, &env->fp_status)   && float32_lt(FST0, FST1, &env->fp_status),
2611
                 !float32_is_unordered(0, FSTH1, FSTH0, &env->fp_status) && float32_lt(FSTH0, FSTH1, &env->fp_status))
2612
FOP_COND_PS(ult, float32_is_unordered(0, FST1, FST0, &env->fp_status)    || float32_lt(FST0, FST1, &env->fp_status),
2613
                 float32_is_unordered(0, FSTH1, FSTH0, &env->fp_status)  || float32_lt(FSTH0, FSTH1, &env->fp_status))
2614
FOP_COND_PS(ole, !float32_is_unordered(0, FST1, FST0, &env->fp_status)   && float32_le(FST0, FST1, &env->fp_status),
2615
                 !float32_is_unordered(0, FSTH1, FSTH0, &env->fp_status) && float32_le(FSTH0, FSTH1, &env->fp_status))
2616
FOP_COND_PS(ule, float32_is_unordered(0, FST1, FST0, &env->fp_status)    || float32_le(FST0, FST1, &env->fp_status),
2617
                 float32_is_unordered(0, FSTH1, FSTH0, &env->fp_status)  || float32_le(FSTH0, FSTH1, &env->fp_status))
2618
/* NOTE: the comma operator will make "cond" to eval to false,
2619
 * but float*_is_unordered() is still called. */
2620
FOP_COND_PS(sf,  (float32_is_unordered(1, FST1, FST0, &env->fp_status), 0),
2621
                 (float32_is_unordered(1, FSTH1, FSTH0, &env->fp_status), 0))
2622
FOP_COND_PS(ngle,float32_is_unordered(1, FST1, FST0, &env->fp_status),
2623
                 float32_is_unordered(1, FSTH1, FSTH0, &env->fp_status))
2624
FOP_COND_PS(seq, !float32_is_unordered(1, FST1, FST0, &env->fp_status)   && float32_eq(FST0, FST1, &env->fp_status),
2625
                 !float32_is_unordered(1, FSTH1, FSTH0, &env->fp_status) && float32_eq(FSTH0, FSTH1, &env->fp_status))
2626
FOP_COND_PS(ngl, float32_is_unordered(1, FST1, FST0, &env->fp_status)    || float32_eq(FST0, FST1, &env->fp_status),
2627
                 float32_is_unordered(1, FSTH1, FSTH0, &env->fp_status)  || float32_eq(FSTH0, FSTH1, &env->fp_status))
2628
FOP_COND_PS(lt,  !float32_is_unordered(1, FST1, FST0, &env->fp_status)   && float32_lt(FST0, FST1, &env->fp_status),
2629
                 !float32_is_unordered(1, FSTH1, FSTH0, &env->fp_status) && float32_lt(FSTH0, FSTH1, &env->fp_status))
2630
FOP_COND_PS(nge, float32_is_unordered(1, FST1, FST0, &env->fp_status)    || float32_lt(FST0, FST1, &env->fp_status),
2631
                 float32_is_unordered(1, FSTH1, FSTH0, &env->fp_status)  || float32_lt(FSTH0, FSTH1, &env->fp_status))
2632
FOP_COND_PS(le,  !float32_is_unordered(1, FST1, FST0, &env->fp_status)   && float32_le(FST0, FST1, &env->fp_status),
2633
                 !float32_is_unordered(1, FSTH1, FSTH0, &env->fp_status) && float32_le(FSTH0, FSTH1, &env->fp_status))
2634
FOP_COND_PS(ngt, float32_is_unordered(1, FST1, FST0, &env->fp_status)    || float32_le(FST0, FST1, &env->fp_status),
2635
                 float32_is_unordered(1, FSTH1, FSTH0, &env->fp_status)  || float32_le(FSTH0, FSTH1, &env->fp_status))
2636

    
2637
void op_bc1f (void)
2638
{
2639
    T0 = !IS_FP_COND_SET(PARAM1, env);
2640
    DEBUG_FPU_STATE();
2641
    RETURN();
2642
}
2643
void op_bc1fany2 (void)
2644
{
2645
    T0 = (!IS_FP_COND_SET(PARAM1, env) ||
2646
          !IS_FP_COND_SET(PARAM1 + 1, env));
2647
    DEBUG_FPU_STATE();
2648
    RETURN();
2649
}
2650
void op_bc1fany4 (void)
2651
{
2652
    T0 = (!IS_FP_COND_SET(PARAM1, env) ||
2653
          !IS_FP_COND_SET(PARAM1 + 1, env) ||
2654
          !IS_FP_COND_SET(PARAM1 + 2, env) ||
2655
          !IS_FP_COND_SET(PARAM1 + 3, env));
2656
    DEBUG_FPU_STATE();
2657
    RETURN();
2658
}
2659

    
2660
void op_bc1t (void)
2661
{
2662
    T0 = IS_FP_COND_SET(PARAM1, env);
2663
    DEBUG_FPU_STATE();
2664
    RETURN();
2665
}
2666
void op_bc1tany2 (void)
2667
{
2668
    T0 = (IS_FP_COND_SET(PARAM1, env) ||
2669
          IS_FP_COND_SET(PARAM1 + 1, env));
2670
    DEBUG_FPU_STATE();
2671
    RETURN();
2672
}
2673
void op_bc1tany4 (void)
2674
{
2675
    T0 = (IS_FP_COND_SET(PARAM1, env) ||
2676
          IS_FP_COND_SET(PARAM1 + 1, env) ||
2677
          IS_FP_COND_SET(PARAM1 + 2, env) ||
2678
          IS_FP_COND_SET(PARAM1 + 3, env));
2679
    DEBUG_FPU_STATE();
2680
    RETURN();
2681
}
2682

    
2683
#if defined(MIPS_USES_R4K_TLB)
2684
void op_tlbwi (void)
2685
{
2686
    CALL_FROM_TB0(do_tlbwi);
2687
    RETURN();
2688
}
2689

    
2690
void op_tlbwr (void)
2691
{
2692
    CALL_FROM_TB0(do_tlbwr);
2693
    RETURN();
2694
}
2695

    
2696
void op_tlbp (void)
2697
{
2698
    CALL_FROM_TB0(do_tlbp);
2699
    RETURN();
2700
}
2701

    
2702
void op_tlbr (void)
2703
{
2704
    CALL_FROM_TB0(do_tlbr);
2705
    RETURN();
2706
}
2707
#endif
2708

    
2709
/* Specials */
2710
#if defined (CONFIG_USER_ONLY)
2711
void op_tls_value (void)
2712
{
2713
    T0 = env->tls_value;
2714
}
2715
#endif
2716

    
2717
void op_pmon (void)
2718
{
2719
    CALL_FROM_TB1(do_pmon, PARAM1);
2720
    RETURN();
2721
}
2722

    
2723
void op_di (void)
2724
{
2725
    T0 = env->CP0_Status;
2726
    env->CP0_Status = T0 & ~(1 << CP0St_IE);
2727
    CALL_FROM_TB1(cpu_mips_update_irq, env);
2728
    RETURN();
2729
}
2730

    
2731
void op_ei (void)
2732
{
2733
    T0 = env->CP0_Status;
2734
    env->CP0_Status = T0 | (1 << CP0St_IE);
2735
    CALL_FROM_TB1(cpu_mips_update_irq, env);
2736
    RETURN();
2737
}
2738

    
2739
void op_trap (void)
2740
{
2741
    if (T0) {
2742
        CALL_FROM_TB1(do_raise_exception, EXCP_TRAP);
2743
    }
2744
    RETURN();
2745
}
2746

    
2747
void op_debug (void)
2748
{
2749
    CALL_FROM_TB1(do_raise_exception, EXCP_DEBUG);
2750
    RETURN();
2751
}
2752

    
2753
void op_set_lladdr (void)
2754
{
2755
    env->CP0_LLAddr = T2;
2756
    RETURN();
2757
}
2758

    
2759
void debug_pre_eret (void);
2760
void debug_post_eret (void);
2761
void op_eret (void)
2762
{
2763
    if (loglevel & CPU_LOG_EXEC)
2764
        CALL_FROM_TB0(debug_pre_eret);
2765
    if (env->CP0_Status & (1 << CP0St_ERL)) {
2766
        env->PC = env->CP0_ErrorEPC;
2767
        env->CP0_Status &= ~(1 << CP0St_ERL);
2768
    } else {
2769
        env->PC = env->CP0_EPC;
2770
        env->CP0_Status &= ~(1 << CP0St_EXL);
2771
    }
2772
    if (!(env->CP0_Status & (1 << CP0St_EXL)) &&
2773
        !(env->CP0_Status & (1 << CP0St_ERL)) &&
2774
        !(env->hflags & MIPS_HFLAG_DM) &&
2775
        (env->CP0_Status & (1 << CP0St_UM)))
2776
        env->hflags |= MIPS_HFLAG_UM;
2777
    if (loglevel & CPU_LOG_EXEC)
2778
        CALL_FROM_TB0(debug_post_eret);
2779
    env->CP0_LLAddr = 1;
2780
    RETURN();
2781
}
2782

    
2783
void op_deret (void)
2784
{
2785
    if (loglevel & CPU_LOG_EXEC)
2786
        CALL_FROM_TB0(debug_pre_eret);
2787
    env->PC = env->CP0_DEPC;
2788
    env->hflags |= MIPS_HFLAG_DM;
2789
    if (!(env->CP0_Status & (1 << CP0St_EXL)) &&
2790
        !(env->CP0_Status & (1 << CP0St_ERL)) &&
2791
        !(env->hflags & MIPS_HFLAG_DM) &&
2792
        (env->CP0_Status & (1 << CP0St_UM)))
2793
        env->hflags |= MIPS_HFLAG_UM;
2794
    if (loglevel & CPU_LOG_EXEC)
2795
        CALL_FROM_TB0(debug_post_eret);
2796
    env->CP0_LLAddr = 1;
2797
    RETURN();
2798
}
2799

    
2800
void op_rdhwr_cpunum(void)
2801
{
2802
    if (!(env->hflags & MIPS_HFLAG_UM) ||
2803
        (env->CP0_HWREna & (1 << 0)) ||
2804
        (env->CP0_Status & (1 << CP0St_CU0)))
2805
        T0 = env->CP0_EBase & 0x3ff;
2806
    else
2807
        CALL_FROM_TB1(do_raise_exception, EXCP_RI);
2808
    RETURN();
2809
}
2810

    
2811
void op_rdhwr_synci_step(void)
2812
{
2813
    if (!(env->hflags & MIPS_HFLAG_UM) ||
2814
        (env->CP0_HWREna & (1 << 1)) ||
2815
        (env->CP0_Status & (1 << CP0St_CU0)))
2816
        T0 = env->SYNCI_Step;
2817
    else
2818
        CALL_FROM_TB1(do_raise_exception, EXCP_RI);
2819
    RETURN();
2820
}
2821

    
2822
void op_rdhwr_cc(void)
2823
{
2824
    if (!(env->hflags & MIPS_HFLAG_UM) ||
2825
        (env->CP0_HWREna & (1 << 2)) ||
2826
        (env->CP0_Status & (1 << CP0St_CU0)))
2827
        T0 = env->CP0_Count;
2828
    else
2829
        CALL_FROM_TB1(do_raise_exception, EXCP_RI);
2830
    RETURN();
2831
}
2832

    
2833
void op_rdhwr_ccres(void)
2834
{
2835
    if (!(env->hflags & MIPS_HFLAG_UM) ||
2836
        (env->CP0_HWREna & (1 << 3)) ||
2837
        (env->CP0_Status & (1 << CP0St_CU0)))
2838
        T0 = env->CCRes;
2839
    else
2840
        CALL_FROM_TB1(do_raise_exception, EXCP_RI);
2841
    RETURN();
2842
}
2843

    
2844
void op_save_state (void)
2845
{
2846
    env->hflags = PARAM1;
2847
    RETURN();
2848
}
2849

    
2850
void op_save_pc (void)
2851
{
2852
    env->PC = PARAM1;
2853
    RETURN();
2854
}
2855

    
2856
void op_save_fp_status (void)
2857
{
2858
    union fps {
2859
        uint32_t i;
2860
        float_status f;
2861
    } fps;
2862
    fps.i = PARAM1;
2863
    env->fp_status = fps.f;
2864
    RETURN();
2865
}
2866

    
2867
void op_interrupt_restart (void)
2868
{
2869
    if (!(env->CP0_Status & (1 << CP0St_EXL)) &&
2870
        !(env->CP0_Status & (1 << CP0St_ERL)) &&
2871
        !(env->hflags & MIPS_HFLAG_DM) &&
2872
        (env->CP0_Status & (1 << CP0St_IE)) &&
2873
        (env->CP0_Status & env->CP0_Cause & CP0Ca_IP_mask)) {
2874
        env->CP0_Cause &= ~(0x1f << CP0Ca_EC);
2875
        CALL_FROM_TB1(do_raise_exception, EXCP_EXT_INTERRUPT);
2876
    }
2877
    RETURN();
2878
}
2879

    
2880
void op_raise_exception (void)
2881
{
2882
    CALL_FROM_TB1(do_raise_exception, PARAM1);
2883
    RETURN();
2884
}
2885

    
2886
void op_raise_exception_err (void)
2887
{
2888
    CALL_FROM_TB2(do_raise_exception_err, PARAM1, PARAM2);
2889
    RETURN();
2890
}
2891

    
2892
void op_exit_tb (void)
2893
{
2894
    EXIT_TB();
2895
    RETURN();
2896
}
2897

    
2898
void op_wait (void)
2899
{
2900
    env->halted = 1;
2901
    CALL_FROM_TB1(do_raise_exception, EXCP_HLT);
2902
    RETURN();
2903
}
2904

    
2905
/* Bitfield operations. */
2906
void op_ext(void)
2907
{
2908
    unsigned int pos = PARAM1;
2909
    unsigned int size = PARAM2;
2910

    
2911
    T0 = ((uint32_t)T1 >> pos) & ((size < 32) ? ((1 << size) - 1) : ~0);
2912
    RETURN();
2913
}
2914

    
2915
void op_ins(void)
2916
{
2917
    unsigned int pos = PARAM1;
2918
    unsigned int size = PARAM2;
2919
    target_ulong mask = ((size < 32) ? ((1 << size) - 1) : ~0) << pos;
2920

    
2921
    T0 = (T0 & ~mask) | (((uint32_t)T1 << pos) & mask);
2922
    RETURN();
2923
}
2924

    
2925
void op_wsbh(void)
2926
{
2927
    T0 = ((T1 << 8) & ~0x00FF00FF) | ((T1 >> 8) & 0x00FF00FF);
2928
    RETURN();
2929
}
2930

    
2931
#ifdef TARGET_MIPS64
2932
void op_dext(void)
2933
{
2934
    unsigned int pos = PARAM1;
2935
    unsigned int size = PARAM2;
2936

    
2937
    T0 = (T1 >> pos) & ((size < 32) ? ((1 << size) - 1) : ~0);
2938
    RETURN();
2939
}
2940

    
2941
void op_dins(void)
2942
{
2943
    unsigned int pos = PARAM1;
2944
    unsigned int size = PARAM2;
2945
    target_ulong mask = ((size < 32) ? ((1 << size) - 1) : ~0) << pos;
2946

    
2947
    T0 = (T0 & ~mask) | ((T1 << pos) & mask);
2948
    RETURN();
2949
}
2950

    
2951
void op_dsbh(void)
2952
{
2953
    T0 = ((T1 << 8) & ~0x00FF00FF00FF00FFULL) | ((T1 >> 8) & 0x00FF00FF00FF00FFULL);
2954
    RETURN();
2955
}
2956

    
2957
void op_dshd(void)
2958
{
2959
    T0 = ((T1 << 16) & ~0x0000FFFF0000FFFFULL) | ((T1 >> 16) & 0x0000FFFF0000FFFFULL);
2960
    RETURN();
2961
}
2962
#endif
2963

    
2964
void op_seb(void)
2965
{
2966
    T0 = ((T1 & 0xFF) ^ 0x80) - 0x80;
2967
    RETURN();
2968
}
2969

    
2970
void op_seh(void)
2971
{
2972
    T0 = ((T1 & 0xFFFF) ^ 0x8000) - 0x8000;
2973
    RETURN();
2974
}