Statistics
| Branch: | Revision:

root / target-sparc / op.c @ dc99a3f2

History | View | Annotate | Download (28.2 kB)

1
/*
2
   SPARC micro operations
3

4
   Copyright (C) 2003 Thomas M. Ogrisegg <tom@fnord.at>
5

6
   This library is free software; you can redistribute it and/or
7
   modify it under the terms of the GNU Lesser General Public
8
   License as published by the Free Software Foundation; either
9
   version 2 of the License, or (at your option) any later version.
10

11
   This library is distributed in the hope that it will be useful,
12
   but WITHOUT ANY WARRANTY; without even the implied warranty of
13
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14
   Lesser General Public License for more details.
15

16
   You should have received a copy of the GNU Lesser General Public
17
   License along with this library; if not, write to the Free Software
18
   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
19
*/
20

    
21
#include "exec.h"
22
#include "helper.h"
23

    
24
#define REGNAME f0
25
#define REG (env->fpr[0])
26
#include "fop_template.h"
27
#define REGNAME f1
28
#define REG (env->fpr[1])
29
#include "fop_template.h"
30
#define REGNAME f2
31
#define REG (env->fpr[2])
32
#include "fop_template.h"
33
#define REGNAME f3
34
#define REG (env->fpr[3])
35
#include "fop_template.h"
36
#define REGNAME f4
37
#define REG (env->fpr[4])
38
#include "fop_template.h"
39
#define REGNAME f5
40
#define REG (env->fpr[5])
41
#include "fop_template.h"
42
#define REGNAME f6
43
#define REG (env->fpr[6])
44
#include "fop_template.h"
45
#define REGNAME f7
46
#define REG (env->fpr[7])
47
#include "fop_template.h"
48
#define REGNAME f8
49
#define REG (env->fpr[8])
50
#include "fop_template.h"
51
#define REGNAME f9
52
#define REG (env->fpr[9])
53
#include "fop_template.h"
54
#define REGNAME f10
55
#define REG (env->fpr[10])
56
#include "fop_template.h"
57
#define REGNAME f11
58
#define REG (env->fpr[11])
59
#include "fop_template.h"
60
#define REGNAME f12
61
#define REG (env->fpr[12])
62
#include "fop_template.h"
63
#define REGNAME f13
64
#define REG (env->fpr[13])
65
#include "fop_template.h"
66
#define REGNAME f14
67
#define REG (env->fpr[14])
68
#include "fop_template.h"
69
#define REGNAME f15
70
#define REG (env->fpr[15])
71
#include "fop_template.h"
72
#define REGNAME f16
73
#define REG (env->fpr[16])
74
#include "fop_template.h"
75
#define REGNAME f17
76
#define REG (env->fpr[17])
77
#include "fop_template.h"
78
#define REGNAME f18
79
#define REG (env->fpr[18])
80
#include "fop_template.h"
81
#define REGNAME f19
82
#define REG (env->fpr[19])
83
#include "fop_template.h"
84
#define REGNAME f20
85
#define REG (env->fpr[20])
86
#include "fop_template.h"
87
#define REGNAME f21
88
#define REG (env->fpr[21])
89
#include "fop_template.h"
90
#define REGNAME f22
91
#define REG (env->fpr[22])
92
#include "fop_template.h"
93
#define REGNAME f23
94
#define REG (env->fpr[23])
95
#include "fop_template.h"
96
#define REGNAME f24
97
#define REG (env->fpr[24])
98
#include "fop_template.h"
99
#define REGNAME f25
100
#define REG (env->fpr[25])
101
#include "fop_template.h"
102
#define REGNAME f26
103
#define REG (env->fpr[26])
104
#include "fop_template.h"
105
#define REGNAME f27
106
#define REG (env->fpr[27])
107
#include "fop_template.h"
108
#define REGNAME f28
109
#define REG (env->fpr[28])
110
#include "fop_template.h"
111
#define REGNAME f29
112
#define REG (env->fpr[29])
113
#include "fop_template.h"
114
#define REGNAME f30
115
#define REG (env->fpr[30])
116
#include "fop_template.h"
117
#define REGNAME f31
118
#define REG (env->fpr[31])
119
#include "fop_template.h"
120

    
121
#ifdef TARGET_SPARC64
122
#define REGNAME f32
123
#define REG (env->fpr[32])
124
#include "fop_template.h"
125
#define REGNAME f34
126
#define REG (env->fpr[34])
127
#include "fop_template.h"
128
#define REGNAME f36
129
#define REG (env->fpr[36])
130
#include "fop_template.h"
131
#define REGNAME f38
132
#define REG (env->fpr[38])
133
#include "fop_template.h"
134
#define REGNAME f40
135
#define REG (env->fpr[40])
136
#include "fop_template.h"
137
#define REGNAME f42
138
#define REG (env->fpr[42])
139
#include "fop_template.h"
140
#define REGNAME f44
141
#define REG (env->fpr[44])
142
#include "fop_template.h"
143
#define REGNAME f46
144
#define REG (env->fpr[46])
145
#include "fop_template.h"
146
#define REGNAME f48
147
#define REG (env->fpr[47])
148
#include "fop_template.h"
149
#define REGNAME f50
150
#define REG (env->fpr[50])
151
#include "fop_template.h"
152
#define REGNAME f52
153
#define REG (env->fpr[52])
154
#include "fop_template.h"
155
#define REGNAME f54
156
#define REG (env->fpr[54])
157
#include "fop_template.h"
158
#define REGNAME f56
159
#define REG (env->fpr[56])
160
#include "fop_template.h"
161
#define REGNAME f58
162
#define REG (env->fpr[58])
163
#include "fop_template.h"
164
#define REGNAME f60
165
#define REG (env->fpr[60])
166
#include "fop_template.h"
167
#define REGNAME f62
168
#define REG (env->fpr[62])
169
#include "fop_template.h"
170
#endif
171

    
172
#define FLAG_SET(x) ((env->psr&x)?1:0)
173

    
174
void OPPROTO op_umul_T1_T0(void)
175
{
176
    uint64_t res;
177
    res = (uint64_t) T0 * (uint64_t) T1;
178
#ifdef TARGET_SPARC64
179
    T0 = res;
180
#else
181
    T0 = res & 0xffffffff;
182
#endif
183
    env->y = res >> 32;
184
}
185

    
186
void OPPROTO op_smul_T1_T0(void)
187
{
188
    uint64_t res;
189
    res = (int64_t) ((int32_t) T0) * (int64_t) ((int32_t) T1);
190
#ifdef TARGET_SPARC64
191
    T0 = res;
192
#else
193
    T0 = res & 0xffffffff;
194
#endif
195
    env->y = res >> 32;
196
}
197

    
198
void OPPROTO op_mulscc_T1_T0(void)
199
{
200
    unsigned int b1, N, V, b2;
201
    target_ulong src1;
202

    
203
    N = FLAG_SET(PSR_NEG);
204
    V = FLAG_SET(PSR_OVF);
205
    b1 = N ^ V;
206
    b2 = T0 & 1;
207
    T0 = (b1 << 31) | (T0 >> 1);
208
    if (!(env->y & 1))
209
        T1 = 0;
210
    /* do addition and update flags */
211
    src1 = T0;
212
    T0 += T1;
213
    env->psr = 0;
214
    if (!T0)
215
        env->psr |= PSR_ZERO;
216
    if ((int32_t) T0 < 0)
217
        env->psr |= PSR_NEG;
218
    if (T0 < src1)
219
        env->psr |= PSR_CARRY;
220
    if (((src1 ^ T1 ^ -1) & (src1 ^ T0)) & (1 << 31))
221
        env->psr |= PSR_OVF;
222
    env->y = (b2 << 31) | (env->y >> 1);
223
    FORCE_RET();
224
}
225

    
226
void OPPROTO op_udiv_T1_T0(void)
227
{
228
    uint64_t x0;
229
    uint32_t x1;
230

    
231
    x0 = T0 | ((uint64_t) (env->y) << 32);
232
    x1 = T1;
233

    
234
    if (x1 == 0) {
235
        raise_exception(TT_DIV_ZERO);
236
    }
237

    
238
    x0 = x0 / x1;
239
    if (x0 > 0xffffffff) {
240
        T0 = 0xffffffff;
241
        T1 = 1;
242
    } else {
243
        T0 = x0;
244
        T1 = 0;
245
    }
246
    FORCE_RET();
247
}
248

    
249
void OPPROTO op_sdiv_T1_T0(void)
250
{
251
    int64_t x0;
252
    int32_t x1;
253

    
254
    x0 = T0 | ((int64_t) (env->y) << 32);
255
    x1 = T1;
256

    
257
    if (x1 == 0) {
258
        raise_exception(TT_DIV_ZERO);
259
    }
260

    
261
    x0 = x0 / x1;
262
    if ((int32_t) x0 != x0) {
263
        T0 = x0 < 0? 0x80000000: 0x7fffffff;
264
        T1 = 1;
265
    } else {
266
        T0 = x0;
267
        T1 = 0;
268
    }
269
    FORCE_RET();
270
}
271

    
272
#ifdef TARGET_SPARC64
273
void OPPROTO op_udivx_T1_T0(void)
274
{
275
    if (T1 == 0) {
276
        raise_exception(TT_DIV_ZERO);
277
    }
278
    T0 /= T1;
279
    FORCE_RET();
280
}
281

    
282
void OPPROTO op_sdivx_T1_T0(void)
283
{
284
    if (T1 == 0) {
285
        raise_exception(TT_DIV_ZERO);
286
    }
287
    if (T0 == INT64_MIN && T1 == -1)
288
        T0 = INT64_MIN;
289
    else
290
        T0 /= (target_long) T1;
291
    FORCE_RET();
292
}
293
#endif
294

    
295
/* Load and store */
296
#define MEMSUFFIX _raw
297
#include "op_mem.h"
298
#if !defined(CONFIG_USER_ONLY)
299
#define MEMSUFFIX _user
300
#include "op_mem.h"
301

    
302
#define MEMSUFFIX _kernel
303
#include "op_mem.h"
304

    
305
#ifdef TARGET_SPARC64
306
#define MEMSUFFIX _hypv
307
#include "op_mem.h"
308
#endif
309
#endif
310

    
311
void OPPROTO op_ldfsr(void)
312
{
313
    PUT_FSR32(env, *((uint32_t *) &FT0));
314
}
315

    
316
void OPPROTO op_stfsr(void)
317
{
318
    *((uint32_t *) &FT0) = GET_FSR32(env);
319
}
320

    
321
#ifndef TARGET_SPARC64
322
/* XXX: use another pointer for %iN registers to avoid slow wrapping
323
   handling ? */
324
void OPPROTO op_save(void)
325
{
326
    uint32_t cwp;
327
    cwp = (env->cwp - 1) & (NWINDOWS - 1);
328
    if (env->wim & (1 << cwp)) {
329
        raise_exception(TT_WIN_OVF);
330
    }
331
    set_cwp(cwp);
332
    FORCE_RET();
333
}
334

    
335
void OPPROTO op_restore(void)
336
{
337
    uint32_t cwp;
338
    cwp = (env->cwp + 1) & (NWINDOWS - 1);
339
    if (env->wim & (1 << cwp)) {
340
        raise_exception(TT_WIN_UNF);
341
    }
342
    set_cwp(cwp);
343
    FORCE_RET();
344
}
345
#else
346
void OPPROTO op_rdccr(void)
347
{
348
    T0 = GET_CCR(env);
349
}
350

    
351
void OPPROTO op_wrccr(void)
352
{
353
    PUT_CCR(env, T0);
354
}
355

    
356
// CWP handling is reversed in V9, but we still use the V8 register
357
// order.
358
void OPPROTO op_rdcwp(void)
359
{
360
    T0 = GET_CWP64(env);
361
}
362

    
363
void OPPROTO op_wrcwp(void)
364
{
365
    PUT_CWP64(env, T0);
366
}
367

    
368
/* XXX: use another pointer for %iN registers to avoid slow wrapping
369
   handling ? */
370
void OPPROTO op_save(void)
371
{
372
    uint32_t cwp;
373
    cwp = (env->cwp - 1) & (NWINDOWS - 1);
374
    if (env->cansave == 0) {
375
        raise_exception(TT_SPILL | (env->otherwin != 0 ?
376
                                    (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
377
                                    ((env->wstate & 0x7) << 2)));
378
    } else {
379
        if (env->cleanwin - env->canrestore == 0) {
380
            // XXX Clean windows without trap
381
            raise_exception(TT_CLRWIN);
382
        } else {
383
            env->cansave--;
384
            env->canrestore++;
385
            set_cwp(cwp);
386
        }
387
    }
388
    FORCE_RET();
389
}
390

    
391
void OPPROTO op_restore(void)
392
{
393
    uint32_t cwp;
394
    cwp = (env->cwp + 1) & (NWINDOWS - 1);
395
    if (env->canrestore == 0) {
396
        raise_exception(TT_FILL | (env->otherwin != 0 ?
397
                                   (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
398
                                   ((env->wstate & 0x7) << 2)));
399
    } else {
400
        env->cansave++;
401
        env->canrestore--;
402
        set_cwp(cwp);
403
    }
404
    FORCE_RET();
405
}
406
#endif
407

    
408
void OPPROTO op_jmp_label(void)
409
{
410
    GOTO_LABEL_PARAM(1);
411
}
412

    
413
#define F_OP(name, p) void OPPROTO op_f##name##p(void)
414

    
415
#if defined(CONFIG_USER_ONLY)
416
#define F_BINOP(name)                                           \
417
    F_OP(name, s)                                               \
418
    {                                                           \
419
        FT0 = float32_ ## name (FT0, FT1, &env->fp_status);     \
420
    }                                                           \
421
    F_OP(name, d)                                               \
422
    {                                                           \
423
        DT0 = float64_ ## name (DT0, DT1, &env->fp_status);     \
424
    }                                                           \
425
    F_OP(name, q)                                               \
426
    {                                                           \
427
        QT0 = float128_ ## name (QT0, QT1, &env->fp_status);    \
428
    }
429
#else
430
#define F_BINOP(name)                                           \
431
    F_OP(name, s)                                               \
432
    {                                                           \
433
        FT0 = float32_ ## name (FT0, FT1, &env->fp_status);     \
434
    }                                                           \
435
    F_OP(name, d)                                               \
436
    {                                                           \
437
        DT0 = float64_ ## name (DT0, DT1, &env->fp_status);     \
438
    }
439
#endif
440

    
441
F_BINOP(add);
442
F_BINOP(sub);
443
F_BINOP(mul);
444
F_BINOP(div);
445
#undef F_BINOP
446

    
447
void OPPROTO op_fsmuld(void)
448
{
449
    DT0 = float64_mul(float32_to_float64(FT0, &env->fp_status),
450
                      float32_to_float64(FT1, &env->fp_status),
451
                      &env->fp_status);
452
}
453

    
454
#if defined(CONFIG_USER_ONLY)
455
void OPPROTO op_fdmulq(void)
456
{
457
    QT0 = float128_mul(float64_to_float128(DT0, &env->fp_status),
458
                       float64_to_float128(DT1, &env->fp_status),
459
                       &env->fp_status);
460
}
461
#endif
462

    
463
#if defined(CONFIG_USER_ONLY)
464
#define F_HELPER(name)    \
465
    F_OP(name, s)         \
466
    {                     \
467
        do_f##name##s();  \
468
    }                     \
469
    F_OP(name, d)         \
470
    {                     \
471
        do_f##name##d();  \
472
    }                     \
473
    F_OP(name, q)         \
474
    {                     \
475
        do_f##name##q();  \
476
    }
477
#else
478
#define F_HELPER(name)    \
479
    F_OP(name, s)         \
480
    {                     \
481
        do_f##name##s();  \
482
    }                     \
483
    F_OP(name, d)         \
484
    {                     \
485
        do_f##name##d();  \
486
    }
487
#endif
488

    
489
F_OP(neg, s)
490
{
491
    FT0 = float32_chs(FT1);
492
}
493

    
494
#ifdef TARGET_SPARC64
495
F_OP(neg, d)
496
{
497
    DT0 = float64_chs(DT1);
498
}
499

    
500
#if defined(CONFIG_USER_ONLY)
501
F_OP(neg, q)
502
{
503
    QT0 = float128_chs(QT1);
504
}
505

    
506
#endif
507

    
508
#endif
509

    
510
/* Integer to float conversion.  */
511
#ifdef USE_INT_TO_FLOAT_HELPERS
512
F_HELPER(ito);
513
#ifdef TARGET_SPARC64
514
F_HELPER(xto);
515
#endif
516
#else
517
F_OP(ito, s)
518
{
519
    FT0 = int32_to_float32(*((int32_t *)&FT1), &env->fp_status);
520
}
521

    
522
F_OP(ito, d)
523
{
524
    DT0 = int32_to_float64(*((int32_t *)&FT1), &env->fp_status);
525
}
526

    
527
#if defined(CONFIG_USER_ONLY)
528
F_OP(ito, q)
529
{
530
    QT0 = int32_to_float128(*((int32_t *)&FT1), &env->fp_status);
531
}
532
#endif
533

    
534
#ifdef TARGET_SPARC64
535
F_OP(xto, s)
536
{
537
    FT0 = int64_to_float32(*((int64_t *)&DT1), &env->fp_status);
538
}
539

    
540
F_OP(xto, d)
541
{
542
    DT0 = int64_to_float64(*((int64_t *)&DT1), &env->fp_status);
543
}
544
#if defined(CONFIG_USER_ONLY)
545
F_OP(xto, q)
546
{
547
    QT0 = int64_to_float128(*((int64_t *)&DT1), &env->fp_status);
548
}
549
#endif
550
#endif
551
#endif
552
#undef F_HELPER
553

    
554
/* floating point conversion */
555
void OPPROTO op_fdtos(void)
556
{
557
    FT0 = float64_to_float32(DT1, &env->fp_status);
558
}
559

    
560
void OPPROTO op_fstod(void)
561
{
562
    DT0 = float32_to_float64(FT1, &env->fp_status);
563
}
564

    
565
#if defined(CONFIG_USER_ONLY)
566
void OPPROTO op_fqtos(void)
567
{
568
    FT0 = float128_to_float32(QT1, &env->fp_status);
569
}
570

    
571
void OPPROTO op_fstoq(void)
572
{
573
    QT0 = float32_to_float128(FT1, &env->fp_status);
574
}
575

    
576
void OPPROTO op_fqtod(void)
577
{
578
    DT0 = float128_to_float64(QT1, &env->fp_status);
579
}
580

    
581
void OPPROTO op_fdtoq(void)
582
{
583
    QT0 = float64_to_float128(DT1, &env->fp_status);
584
}
585
#endif
586

    
587
/* Float to integer conversion.  */
588
void OPPROTO op_fstoi(void)
589
{
590
    *((int32_t *)&FT0) = float32_to_int32_round_to_zero(FT1, &env->fp_status);
591
}
592

    
593
void OPPROTO op_fdtoi(void)
594
{
595
    *((int32_t *)&FT0) = float64_to_int32_round_to_zero(DT1, &env->fp_status);
596
}
597

    
598
#if defined(CONFIG_USER_ONLY)
599
void OPPROTO op_fqtoi(void)
600
{
601
    *((int32_t *)&FT0) = float128_to_int32_round_to_zero(QT1, &env->fp_status);
602
}
603
#endif
604

    
605
#ifdef TARGET_SPARC64
606
void OPPROTO op_fstox(void)
607
{
608
    *((int64_t *)&DT0) = float32_to_int64_round_to_zero(FT1, &env->fp_status);
609
}
610

    
611
void OPPROTO op_fdtox(void)
612
{
613
    *((int64_t *)&DT0) = float64_to_int64_round_to_zero(DT1, &env->fp_status);
614
}
615

    
616
#if defined(CONFIG_USER_ONLY)
617
void OPPROTO op_fqtox(void)
618
{
619
    *((int64_t *)&DT0) = float128_to_int64_round_to_zero(QT1, &env->fp_status);
620
}
621
#endif
622

    
623
void OPPROTO op_flushw(void)
624
{
625
    if (env->cansave != NWINDOWS - 2) {
626
        raise_exception(TT_SPILL | (env->otherwin != 0 ?
627
                                    (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
628
                                    ((env->wstate & 0x7) << 2)));
629
    }
630
}
631

    
632
void OPPROTO op_saved(void)
633
{
634
    env->cansave++;
635
    if (env->otherwin == 0)
636
        env->canrestore--;
637
    else
638
        env->otherwin--;
639
    FORCE_RET();
640
}
641

    
642
void OPPROTO op_restored(void)
643
{
644
    env->canrestore++;
645
    if (env->cleanwin < NWINDOWS - 1)
646
        env->cleanwin++;
647
    if (env->otherwin == 0)
648
        env->cansave--;
649
    else
650
        env->otherwin--;
651
    FORCE_RET();
652
}
653
#endif
654

    
655
#ifdef TARGET_SPARC64
656
// This function uses non-native bit order
657
#define GET_FIELD(X, FROM, TO)                                  \
658
    ((X) >> (63 - (TO)) & ((1ULL << ((TO) - (FROM) + 1)) - 1))
659

    
660
// This function uses the order in the manuals, i.e. bit 0 is 2^0
661
#define GET_FIELD_SP(X, FROM, TO)               \
662
    GET_FIELD(X, 63 - (TO), 63 - (FROM))
663

    
664
void OPPROTO op_array8()
665
{
666
    T0 = (GET_FIELD_SP(T0, 60, 63) << (17 + 2 * T1)) |
667
        (GET_FIELD_SP(T0, 39, 39 + T1 - 1) << (17 + T1)) |
668
        (GET_FIELD_SP(T0, 17 + T1 - 1, 17) << 17) |
669
        (GET_FIELD_SP(T0, 56, 59) << 13) | (GET_FIELD_SP(T0, 35, 38) << 9) |
670
        (GET_FIELD_SP(T0, 13, 16) << 5) | (((T0 >> 55) & 1) << 4) |
671
        (GET_FIELD_SP(T0, 33, 34) << 2) | GET_FIELD_SP(T0, 11, 12);
672
}
673

    
674
void OPPROTO op_array16()
675
{
676
    T0 = ((GET_FIELD_SP(T0, 60, 63) << (17 + 2 * T1)) |
677
          (GET_FIELD_SP(T0, 39, 39 + T1 - 1) << (17 + T1)) |
678
          (GET_FIELD_SP(T0, 17 + T1 - 1, 17) << 17) |
679
          (GET_FIELD_SP(T0, 56, 59) << 13) | (GET_FIELD_SP(T0, 35, 38) << 9) |
680
          (GET_FIELD_SP(T0, 13, 16) << 5) | (((T0 >> 55) & 1) << 4) |
681
          (GET_FIELD_SP(T0, 33, 34) << 2) | GET_FIELD_SP(T0, 11, 12)) << 1;
682
}
683

    
684
void OPPROTO op_array32()
685
{
686
    T0 = ((GET_FIELD_SP(T0, 60, 63) << (17 + 2 * T1)) |
687
          (GET_FIELD_SP(T0, 39, 39 + T1 - 1) << (17 + T1)) |
688
          (GET_FIELD_SP(T0, 17 + T1 - 1, 17) << 17) |
689
          (GET_FIELD_SP(T0, 56, 59) << 13) | (GET_FIELD_SP(T0, 35, 38) << 9) |
690
          (GET_FIELD_SP(T0, 13, 16) << 5) | (((T0 >> 55) & 1) << 4) |
691
          (GET_FIELD_SP(T0, 33, 34) << 2) | GET_FIELD_SP(T0, 11, 12)) << 2;
692
}
693

    
694
void OPPROTO op_alignaddr()
695
{
696
    uint64_t tmp;
697

    
698
    tmp = T0 + T1;
699
    env->gsr &= ~7ULL;
700
    env->gsr |= tmp & 7ULL;
701
    T0 = tmp & ~7ULL;
702
}
703

    
704
void OPPROTO op_faligndata()
705
{
706
    uint64_t tmp;
707

    
708
    tmp = (*((uint64_t *)&DT0)) << ((env->gsr & 7) * 8);
709
    tmp |= (*((uint64_t *)&DT1)) >> (64 - (env->gsr & 7) * 8);
710
    *((uint64_t *)&DT0) = tmp;
711
}
712

    
713
void OPPROTO op_movl_FT0_0(void)
714
{
715
    *((uint32_t *)&FT0) = 0;
716
}
717

    
718
void OPPROTO op_movl_DT0_0(void)
719
{
720
    *((uint64_t *)&DT0) = 0;
721
}
722

    
723
void OPPROTO op_movl_FT0_1(void)
724
{
725
    *((uint32_t *)&FT0) = 0xffffffff;
726
}
727

    
728
void OPPROTO op_movl_DT0_1(void)
729
{
730
    *((uint64_t *)&DT0) = 0xffffffffffffffffULL;
731
}
732

    
733
void OPPROTO op_fnot(void)
734
{
735
    *(uint64_t *)&DT0 = ~*(uint64_t *)&DT1;
736
}
737

    
738
void OPPROTO op_fnots(void)
739
{
740
    *(uint32_t *)&FT0 = ~*(uint32_t *)&FT1;
741
}
742

    
743
void OPPROTO op_fnor(void)
744
{
745
    *(uint64_t *)&DT0 = ~(*(uint64_t *)&DT0 | *(uint64_t *)&DT1);
746
}
747

    
748
void OPPROTO op_fnors(void)
749
{
750
    *(uint32_t *)&FT0 = ~(*(uint32_t *)&FT0 | *(uint32_t *)&FT1);
751
}
752

    
753
void OPPROTO op_for(void)
754
{
755
    *(uint64_t *)&DT0 |= *(uint64_t *)&DT1;
756
}
757

    
758
void OPPROTO op_fors(void)
759
{
760
    *(uint32_t *)&FT0 |= *(uint32_t *)&FT1;
761
}
762

    
763
void OPPROTO op_fxor(void)
764
{
765
    *(uint64_t *)&DT0 ^= *(uint64_t *)&DT1;
766
}
767

    
768
void OPPROTO op_fxors(void)
769
{
770
    *(uint32_t *)&FT0 ^= *(uint32_t *)&FT1;
771
}
772

    
773
void OPPROTO op_fand(void)
774
{
775
    *(uint64_t *)&DT0 &= *(uint64_t *)&DT1;
776
}
777

    
778
void OPPROTO op_fands(void)
779
{
780
    *(uint32_t *)&FT0 &= *(uint32_t *)&FT1;
781
}
782

    
783
void OPPROTO op_fornot(void)
784
{
785
    *(uint64_t *)&DT0 = *(uint64_t *)&DT0 | ~*(uint64_t *)&DT1;
786
}
787

    
788
void OPPROTO op_fornots(void)
789
{
790
    *(uint32_t *)&FT0 = *(uint32_t *)&FT0 | ~*(uint32_t *)&FT1;
791
}
792

    
793
void OPPROTO op_fandnot(void)
794
{
795
    *(uint64_t *)&DT0 = *(uint64_t *)&DT0 & ~*(uint64_t *)&DT1;
796
}
797

    
798
void OPPROTO op_fandnots(void)
799
{
800
    *(uint32_t *)&FT0 = *(uint32_t *)&FT0 & ~*(uint32_t *)&FT1;
801
}
802

    
803
void OPPROTO op_fnand(void)
804
{
805
    *(uint64_t *)&DT0 = ~(*(uint64_t *)&DT0 & *(uint64_t *)&DT1);
806
}
807

    
808
void OPPROTO op_fnands(void)
809
{
810
    *(uint32_t *)&FT0 = ~(*(uint32_t *)&FT0 & *(uint32_t *)&FT1);
811
}
812

    
813
void OPPROTO op_fxnor(void)
814
{
815
    *(uint64_t *)&DT0 ^= ~*(uint64_t *)&DT1;
816
}
817

    
818
void OPPROTO op_fxnors(void)
819
{
820
    *(uint32_t *)&FT0 ^= ~*(uint32_t *)&FT1;
821
}
822

    
823
#ifdef WORDS_BIGENDIAN
824
#define VIS_B64(n) b[7 - (n)]
825
#define VIS_W64(n) w[3 - (n)]
826
#define VIS_SW64(n) sw[3 - (n)]
827
#define VIS_L64(n) l[1 - (n)]
828
#define VIS_B32(n) b[3 - (n)]
829
#define VIS_W32(n) w[1 - (n)]
830
#else
831
#define VIS_B64(n) b[n]
832
#define VIS_W64(n) w[n]
833
#define VIS_SW64(n) sw[n]
834
#define VIS_L64(n) l[n]
835
#define VIS_B32(n) b[n]
836
#define VIS_W32(n) w[n]
837
#endif
838

    
839
typedef union {
840
    uint8_t b[8];
841
    uint16_t w[4];
842
    int16_t sw[4];
843
    uint32_t l[2];
844
    float64 d;
845
} vis64;
846

    
847
typedef union {
848
    uint8_t b[4];
849
    uint16_t w[2];
850
    uint32_t l;
851
    float32 f;
852
} vis32;
853

    
854
void OPPROTO op_fpmerge(void)
855
{
856
    vis64 s, d;
857

    
858
    s.d = DT0;
859
    d.d = DT1;
860

    
861
    // Reverse calculation order to handle overlap
862
    d.VIS_B64(7) = s.VIS_B64(3);
863
    d.VIS_B64(6) = d.VIS_B64(3);
864
    d.VIS_B64(5) = s.VIS_B64(2);
865
    d.VIS_B64(4) = d.VIS_B64(2);
866
    d.VIS_B64(3) = s.VIS_B64(1);
867
    d.VIS_B64(2) = d.VIS_B64(1);
868
    d.VIS_B64(1) = s.VIS_B64(0);
869
    //d.VIS_B64(0) = d.VIS_B64(0);
870

    
871
    DT0 = d.d;
872
}
873

    
874
void OPPROTO op_fmul8x16(void)
875
{
876
    vis64 s, d;
877
    uint32_t tmp;
878

    
879
    s.d = DT0;
880
    d.d = DT1;
881

    
882
#define PMUL(r)                                                 \
883
    tmp = (int32_t)d.VIS_SW64(r) * (int32_t)s.VIS_B64(r);       \
884
    if ((tmp & 0xff) > 0x7f)                                    \
885
        tmp += 0x100;                                           \
886
    d.VIS_W64(r) = tmp >> 8;
887

    
888
    PMUL(0);
889
    PMUL(1);
890
    PMUL(2);
891
    PMUL(3);
892
#undef PMUL
893

    
894
    DT0 = d.d;
895
}
896

    
897
void OPPROTO op_fmul8x16al(void)
898
{
899
    vis64 s, d;
900
    uint32_t tmp;
901

    
902
    s.d = DT0;
903
    d.d = DT1;
904

    
905
#define PMUL(r)                                                 \
906
    tmp = (int32_t)d.VIS_SW64(1) * (int32_t)s.VIS_B64(r);       \
907
    if ((tmp & 0xff) > 0x7f)                                    \
908
        tmp += 0x100;                                           \
909
    d.VIS_W64(r) = tmp >> 8;
910

    
911
    PMUL(0);
912
    PMUL(1);
913
    PMUL(2);
914
    PMUL(3);
915
#undef PMUL
916

    
917
    DT0 = d.d;
918
}
919

    
920
void OPPROTO op_fmul8x16au(void)
921
{
922
    vis64 s, d;
923
    uint32_t tmp;
924

    
925
    s.d = DT0;
926
    d.d = DT1;
927

    
928
#define PMUL(r)                                                 \
929
    tmp = (int32_t)d.VIS_SW64(0) * (int32_t)s.VIS_B64(r);       \
930
    if ((tmp & 0xff) > 0x7f)                                    \
931
        tmp += 0x100;                                           \
932
    d.VIS_W64(r) = tmp >> 8;
933

    
934
    PMUL(0);
935
    PMUL(1);
936
    PMUL(2);
937
    PMUL(3);
938
#undef PMUL
939

    
940
    DT0 = d.d;
941
}
942

    
943
void OPPROTO op_fmul8sux16(void)
944
{
945
    vis64 s, d;
946
    uint32_t tmp;
947

    
948
    s.d = DT0;
949
    d.d = DT1;
950

    
951
#define PMUL(r)                                                         \
952
    tmp = (int32_t)d.VIS_SW64(r) * ((int32_t)s.VIS_SW64(r) >> 8);       \
953
    if ((tmp & 0xff) > 0x7f)                                            \
954
        tmp += 0x100;                                                   \
955
    d.VIS_W64(r) = tmp >> 8;
956

    
957
    PMUL(0);
958
    PMUL(1);
959
    PMUL(2);
960
    PMUL(3);
961
#undef PMUL
962

    
963
    DT0 = d.d;
964
}
965

    
966
void OPPROTO op_fmul8ulx16(void)
967
{
968
    vis64 s, d;
969
    uint32_t tmp;
970

    
971
    s.d = DT0;
972
    d.d = DT1;
973

    
974
#define PMUL(r)                                                         \
975
    tmp = (int32_t)d.VIS_SW64(r) * ((uint32_t)s.VIS_B64(r * 2));        \
976
    if ((tmp & 0xff) > 0x7f)                                            \
977
        tmp += 0x100;                                                   \
978
    d.VIS_W64(r) = tmp >> 8;
979

    
980
    PMUL(0);
981
    PMUL(1);
982
    PMUL(2);
983
    PMUL(3);
984
#undef PMUL
985

    
986
    DT0 = d.d;
987
}
988

    
989
void OPPROTO op_fmuld8sux16(void)
990
{
991
    vis64 s, d;
992
    uint32_t tmp;
993

    
994
    s.d = DT0;
995
    d.d = DT1;
996

    
997
#define PMUL(r)                                                         \
998
    tmp = (int32_t)d.VIS_SW64(r) * ((int32_t)s.VIS_SW64(r) >> 8);       \
999
    if ((tmp & 0xff) > 0x7f)                                            \
1000
        tmp += 0x100;                                                   \
1001
    d.VIS_L64(r) = tmp;
1002

    
1003
    // Reverse calculation order to handle overlap
1004
    PMUL(1);
1005
    PMUL(0);
1006
#undef PMUL
1007

    
1008
    DT0 = d.d;
1009
}
1010

    
1011
void OPPROTO op_fmuld8ulx16(void)
1012
{
1013
    vis64 s, d;
1014
    uint32_t tmp;
1015

    
1016
    s.d = DT0;
1017
    d.d = DT1;
1018

    
1019
#define PMUL(r)                                                         \
1020
    tmp = (int32_t)d.VIS_SW64(r) * ((uint32_t)s.VIS_B64(r * 2));        \
1021
    if ((tmp & 0xff) > 0x7f)                                            \
1022
        tmp += 0x100;                                                   \
1023
    d.VIS_L64(r) = tmp;
1024

    
1025
    // Reverse calculation order to handle overlap
1026
    PMUL(1);
1027
    PMUL(0);
1028
#undef PMUL
1029

    
1030
    DT0 = d.d;
1031
}
1032

    
1033
void OPPROTO op_fexpand(void)
1034
{
1035
    vis32 s;
1036
    vis64 d;
1037

    
1038
    s.l = (uint32_t)(*(uint64_t *)&DT0 & 0xffffffff);
1039
    d.d = DT1;
1040
    d.VIS_L64(0) = s.VIS_W32(0) << 4;
1041
    d.VIS_L64(1) = s.VIS_W32(1) << 4;
1042
    d.VIS_L64(2) = s.VIS_W32(2) << 4;
1043
    d.VIS_L64(3) = s.VIS_W32(3) << 4;
1044

    
1045
    DT0 = d.d;
1046
}
1047

    
1048
#define VIS_OP(name, F)                                 \
1049
    void OPPROTO name##16(void)                         \
1050
    {                                                   \
1051
        vis64 s, d;                                     \
1052
                                                        \
1053
        s.d = DT0;                                      \
1054
        d.d = DT1;                                      \
1055
                                                        \
1056
        d.VIS_W64(0) = F(d.VIS_W64(0), s.VIS_W64(0));   \
1057
        d.VIS_W64(1) = F(d.VIS_W64(1), s.VIS_W64(1));   \
1058
        d.VIS_W64(2) = F(d.VIS_W64(2), s.VIS_W64(2));   \
1059
        d.VIS_W64(3) = F(d.VIS_W64(3), s.VIS_W64(3));   \
1060
                                                        \
1061
        DT0 = d.d;                                      \
1062
    }                                                   \
1063
                                                        \
1064
    void OPPROTO name##16s(void)                        \
1065
    {                                                   \
1066
        vis32 s, d;                                     \
1067
                                                        \
1068
        s.f = FT0;                                      \
1069
        d.f = FT1;                                      \
1070
                                                        \
1071
        d.VIS_W32(0) = F(d.VIS_W32(0), s.VIS_W32(0));   \
1072
        d.VIS_W32(1) = F(d.VIS_W32(1), s.VIS_W32(1));   \
1073
                                                        \
1074
        FT0 = d.f;                                      \
1075
    }                                                   \
1076
                                                        \
1077
    void OPPROTO name##32(void)                         \
1078
    {                                                   \
1079
        vis64 s, d;                                     \
1080
                                                        \
1081
        s.d = DT0;                                      \
1082
        d.d = DT1;                                      \
1083
                                                        \
1084
        d.VIS_L64(0) = F(d.VIS_L64(0), s.VIS_L64(0));   \
1085
        d.VIS_L64(1) = F(d.VIS_L64(1), s.VIS_L64(1));   \
1086
                                                        \
1087
        DT0 = d.d;                                      \
1088
    }                                                   \
1089
                                                        \
1090
    void OPPROTO name##32s(void)                        \
1091
    {                                                   \
1092
        vis32 s, d;                                     \
1093
                                                        \
1094
        s.f = FT0;                                      \
1095
        d.f = FT1;                                      \
1096
                                                        \
1097
        d.l = F(d.l, s.l);                              \
1098
                                                        \
1099
        FT0 = d.f;                                      \
1100
    }
1101

    
1102
#define FADD(a, b) ((a) + (b))
1103
#define FSUB(a, b) ((a) - (b))
1104
VIS_OP(op_fpadd, FADD)
1105
VIS_OP(op_fpsub, FSUB)
1106

    
1107
#define VIS_CMPOP(name, F)                                        \
1108
    void OPPROTO name##16(void)                                   \
1109
    {                                                             \
1110
        vis64 s, d;                                               \
1111
                                                                  \
1112
        s.d = DT0;                                                \
1113
        d.d = DT1;                                                \
1114
                                                                  \
1115
        d.VIS_W64(0) = F(d.VIS_W64(0), s.VIS_W64(0))? 1: 0;       \
1116
        d.VIS_W64(0) |= F(d.VIS_W64(1), s.VIS_W64(1))? 2: 0;      \
1117
        d.VIS_W64(0) |= F(d.VIS_W64(2), s.VIS_W64(2))? 4: 0;      \
1118
        d.VIS_W64(0) |= F(d.VIS_W64(3), s.VIS_W64(3))? 8: 0;      \
1119
                                                                  \
1120
        DT0 = d.d;                                                \
1121
    }                                                             \
1122
                                                                  \
1123
    void OPPROTO name##32(void)                                   \
1124
    {                                                             \
1125
        vis64 s, d;                                               \
1126
                                                                  \
1127
        s.d = DT0;                                                \
1128
        d.d = DT1;                                                \
1129
                                                                  \
1130
        d.VIS_L64(0) = F(d.VIS_L64(0), s.VIS_L64(0))? 1: 0;       \
1131
        d.VIS_L64(0) |= F(d.VIS_L64(1), s.VIS_L64(1))? 2: 0;      \
1132
                                                                  \
1133
        DT0 = d.d;                                                \
1134
    }
1135

    
1136
#define FCMPGT(a, b) ((a) > (b))
1137
#define FCMPEQ(a, b) ((a) == (b))
1138
#define FCMPLE(a, b) ((a) <= (b))
1139
#define FCMPNE(a, b) ((a) != (b))
1140

    
1141
VIS_CMPOP(op_fcmpgt, FCMPGT)
1142
VIS_CMPOP(op_fcmpeq, FCMPEQ)
1143
VIS_CMPOP(op_fcmple, FCMPLE)
1144
VIS_CMPOP(op_fcmpne, FCMPNE)
1145

    
1146
#endif
1147

    
1148
#define CHECK_ALIGN_OP(align)                           \
1149
    void OPPROTO op_check_align_T0_ ## align (void)     \
1150
    {                                                   \
1151
        if (T0 & align)                                 \
1152
            raise_exception(TT_UNALIGNED);              \
1153
        FORCE_RET();                                    \
1154
    }
1155

    
1156
CHECK_ALIGN_OP(1)
1157
CHECK_ALIGN_OP(3)
1158
CHECK_ALIGN_OP(7)