Statistics
| Branch: | Revision:

root / tests / test-i386.c @ 2edcdce3

History | View | Annotate | Download (41.4 kB)

1
/*
2
 *  x86 CPU test
3
 * 
4
 *  Copyright (c) 2003 Fabrice Bellard
5
 *
6
 *  This program is free software; you can redistribute it and/or modify
7
 *  it under the terms of the GNU General Public License as published by
8
 *  the Free Software Foundation; either version 2 of the License, or
9
 *  (at your option) any later version.
10
 *
11
 *  This program 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
14
 *  GNU General Public License for more details.
15
 *
16
 *  You should have received a copy of the GNU General Public License
17
 *  along with this program; if not, write to the Free Software
18
 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19
 */
20
#define _GNU_SOURCE
21
#include <stdlib.h>
22
#include <stdio.h>
23
#include <string.h>
24
#include <inttypes.h>
25
#include <math.h>
26
#include <signal.h>
27
#include <setjmp.h>
28
#include <errno.h>
29
#include <sys/ucontext.h>
30
#include <sys/mman.h>
31
#include <asm/vm86.h>
32

    
33
#define TEST_CMOV  0
34
#define TEST_FCOMI 0
35
//#define LINUX_VM86_IOPL_FIX
36
//#define TEST_P4_FLAGS
37

    
38
#define xglue(x, y) x ## y
39
#define glue(x, y) xglue(x, y)
40
#define stringify(s)        tostring(s)
41
#define tostring(s)        #s
42

    
43
#define CC_C           0x0001
44
#define CC_P         0x0004
45
#define CC_A        0x0010
46
#define CC_Z        0x0040
47
#define CC_S    0x0080
48
#define CC_O    0x0800
49

    
50
#define __init_call        __attribute__ ((unused,__section__ (".initcall.init")))
51

    
52
static void *call_start __init_call = NULL;
53

    
54
#define CC_MASK (CC_C | CC_P | CC_Z | CC_S | CC_O | CC_A)
55

    
56
#define OP add
57
#include "test-i386.h"
58

    
59
#define OP sub
60
#include "test-i386.h"
61

    
62
#define OP xor
63
#include "test-i386.h"
64

    
65
#define OP and
66
#include "test-i386.h"
67

    
68
#define OP or
69
#include "test-i386.h"
70

    
71
#define OP cmp
72
#include "test-i386.h"
73

    
74
#define OP adc
75
#define OP_CC
76
#include "test-i386.h"
77

    
78
#define OP sbb
79
#define OP_CC
80
#include "test-i386.h"
81

    
82
#define OP inc
83
#define OP_CC
84
#define OP1
85
#include "test-i386.h"
86

    
87
#define OP dec
88
#define OP_CC
89
#define OP1
90
#include "test-i386.h"
91

    
92
#define OP neg
93
#define OP_CC
94
#define OP1
95
#include "test-i386.h"
96

    
97
#define OP not
98
#define OP_CC
99
#define OP1
100
#include "test-i386.h"
101

    
102
#undef CC_MASK
103
#define CC_MASK (CC_C | CC_P | CC_Z | CC_S | CC_O)
104

    
105
#define OP shl
106
#include "test-i386-shift.h"
107

    
108
#define OP shr
109
#include "test-i386-shift.h"
110

    
111
#define OP sar
112
#include "test-i386-shift.h"
113

    
114
#define OP rol
115
#include "test-i386-shift.h"
116

    
117
#define OP ror
118
#include "test-i386-shift.h"
119

    
120
#define OP rcr
121
#define OP_CC
122
#include "test-i386-shift.h"
123

    
124
#define OP rcl
125
#define OP_CC
126
#include "test-i386-shift.h"
127

    
128
#define OP shld
129
#define OP_SHIFTD
130
#define OP_NOBYTE
131
#include "test-i386-shift.h"
132

    
133
#define OP shrd
134
#define OP_SHIFTD
135
#define OP_NOBYTE
136
#include "test-i386-shift.h"
137

    
138
/* XXX: should be more precise ? */
139
#undef CC_MASK
140
#define CC_MASK (CC_C)
141

    
142
#define OP bt
143
#define OP_NOBYTE
144
#include "test-i386-shift.h"
145

    
146
#define OP bts
147
#define OP_NOBYTE
148
#include "test-i386-shift.h"
149

    
150
#define OP btr
151
#define OP_NOBYTE
152
#include "test-i386-shift.h"
153

    
154
#define OP btc
155
#define OP_NOBYTE
156
#include "test-i386-shift.h"
157

    
158
/* lea test (modrm support) */
159
#define TEST_LEA(STR)\
160
{\
161
    asm("leal " STR ", %0"\
162
        : "=r" (res)\
163
        : "a" (eax), "b" (ebx), "c" (ecx), "d" (edx), "S" (esi), "D" (edi));\
164
    printf("lea %s = %08x\n", STR, res);\
165
}
166

    
167
#define TEST_LEA16(STR)\
168
{\
169
    asm(".code16 ; .byte 0x67 ; leal " STR ", %0 ; .code32"\
170
        : "=wq" (res)\
171
        : "a" (eax), "b" (ebx), "c" (ecx), "d" (edx), "S" (esi), "D" (edi));\
172
    printf("lea %s = %08x\n", STR, res);\
173
}
174

    
175

    
176
void test_lea(void)
177
{
178
    int eax, ebx, ecx, edx, esi, edi, res;
179
    eax = 0x0001;
180
    ebx = 0x0002;
181
    ecx = 0x0004;
182
    edx = 0x0008;
183
    esi = 0x0010;
184
    edi = 0x0020;
185

    
186
    TEST_LEA("0x4000");
187

    
188
    TEST_LEA("(%%eax)");
189
    TEST_LEA("(%%ebx)");
190
    TEST_LEA("(%%ecx)");
191
    TEST_LEA("(%%edx)");
192
    TEST_LEA("(%%esi)");
193
    TEST_LEA("(%%edi)");
194

    
195
    TEST_LEA("0x40(%%eax)");
196
    TEST_LEA("0x40(%%ebx)");
197
    TEST_LEA("0x40(%%ecx)");
198
    TEST_LEA("0x40(%%edx)");
199
    TEST_LEA("0x40(%%esi)");
200
    TEST_LEA("0x40(%%edi)");
201

    
202
    TEST_LEA("0x4000(%%eax)");
203
    TEST_LEA("0x4000(%%ebx)");
204
    TEST_LEA("0x4000(%%ecx)");
205
    TEST_LEA("0x4000(%%edx)");
206
    TEST_LEA("0x4000(%%esi)");
207
    TEST_LEA("0x4000(%%edi)");
208

    
209
    TEST_LEA("(%%eax, %%ecx)");
210
    TEST_LEA("(%%ebx, %%edx)");
211
    TEST_LEA("(%%ecx, %%ecx)");
212
    TEST_LEA("(%%edx, %%ecx)");
213
    TEST_LEA("(%%esi, %%ecx)");
214
    TEST_LEA("(%%edi, %%ecx)");
215

    
216
    TEST_LEA("0x40(%%eax, %%ecx)");
217
    TEST_LEA("0x4000(%%ebx, %%edx)");
218

    
219
    TEST_LEA("(%%ecx, %%ecx, 2)");
220
    TEST_LEA("(%%edx, %%ecx, 4)");
221
    TEST_LEA("(%%esi, %%ecx, 8)");
222

    
223
    TEST_LEA("(,%%eax, 2)");
224
    TEST_LEA("(,%%ebx, 4)");
225
    TEST_LEA("(,%%ecx, 8)");
226

    
227
    TEST_LEA("0x40(,%%eax, 2)");
228
    TEST_LEA("0x40(,%%ebx, 4)");
229
    TEST_LEA("0x40(,%%ecx, 8)");
230

    
231

    
232
    TEST_LEA("-10(%%ecx, %%ecx, 2)");
233
    TEST_LEA("-10(%%edx, %%ecx, 4)");
234
    TEST_LEA("-10(%%esi, %%ecx, 8)");
235

    
236
    TEST_LEA("0x4000(%%ecx, %%ecx, 2)");
237
    TEST_LEA("0x4000(%%edx, %%ecx, 4)");
238
    TEST_LEA("0x4000(%%esi, %%ecx, 8)");
239

    
240
    /* limited 16 bit addressing test */
241
    TEST_LEA16("0x4000");
242
    TEST_LEA16("(%%bx)");
243
    TEST_LEA16("(%%si)");
244
    TEST_LEA16("(%%di)");
245
    TEST_LEA16("0x40(%%bx)");
246
    TEST_LEA16("0x40(%%si)");
247
    TEST_LEA16("0x40(%%di)");
248
    TEST_LEA16("0x4000(%%bx)");
249
    TEST_LEA16("0x4000(%%si)");
250
    TEST_LEA16("(%%bx,%%si)");
251
    TEST_LEA16("(%%bx,%%di)");
252
    TEST_LEA16("0x40(%%bx,%%si)");
253
    TEST_LEA16("0x40(%%bx,%%di)");
254
    TEST_LEA16("0x4000(%%bx,%%si)");
255
    TEST_LEA16("0x4000(%%bx,%%di)");
256
}
257

    
258
#define TEST_JCC(JCC, v1, v2)\
259
{\
260
    int res;\
261
    asm("movl $1, %0\n\t"\
262
        "cmpl %2, %1\n\t"\
263
        "j" JCC " 1f\n\t"\
264
        "movl $0, %0\n\t"\
265
        "1:\n\t"\
266
        : "=r" (res)\
267
        : "r" (v1), "r" (v2));\
268
    printf("%-10s %d\n", "j" JCC, res);\
269
\
270
    asm("movl $0, %0\n\t"\
271
        "cmpl %2, %1\n\t"\
272
        "set" JCC " %b0\n\t"\
273
        : "=r" (res)\
274
        : "r" (v1), "r" (v2));\
275
    printf("%-10s %d\n", "set" JCC, res);\
276
 if (TEST_CMOV) {\
277
    asm("movl $0x12345678, %0\n\t"\
278
        "cmpl %2, %1\n\t"\
279
        "cmov" JCC "l %3, %0\n\t"\
280
        : "=r" (res)\
281
        : "r" (v1), "r" (v2), "m" (1));\
282
        printf("%-10s R=0x%08x\n", "cmov" JCC "l", res);\
283
    asm("movl $0x12345678, %0\n\t"\
284
        "cmpl %2, %1\n\t"\
285
        "cmov" JCC "w %w3, %w0\n\t"\
286
        : "=r" (res)\
287
        : "r" (v1), "r" (v2), "r" (1));\
288
        printf("%-10s R=0x%08x\n", "cmov" JCC "w", res);\
289
 } \
290
}
291

    
292
/* various jump tests */
293
void test_jcc(void)
294
{
295
    TEST_JCC("ne", 1, 1);
296
    TEST_JCC("ne", 1, 0);
297

    
298
    TEST_JCC("e", 1, 1);
299
    TEST_JCC("e", 1, 0);
300

    
301
    TEST_JCC("l", 1, 1);
302
    TEST_JCC("l", 1, 0);
303
    TEST_JCC("l", 1, -1);
304

    
305
    TEST_JCC("le", 1, 1);
306
    TEST_JCC("le", 1, 0);
307
    TEST_JCC("le", 1, -1);
308

    
309
    TEST_JCC("ge", 1, 1);
310
    TEST_JCC("ge", 1, 0);
311
    TEST_JCC("ge", -1, 1);
312

    
313
    TEST_JCC("g", 1, 1);
314
    TEST_JCC("g", 1, 0);
315
    TEST_JCC("g", 1, -1);
316

    
317
    TEST_JCC("b", 1, 1);
318
    TEST_JCC("b", 1, 0);
319
    TEST_JCC("b", 1, -1);
320

    
321
    TEST_JCC("be", 1, 1);
322
    TEST_JCC("be", 1, 0);
323
    TEST_JCC("be", 1, -1);
324

    
325
    TEST_JCC("ae", 1, 1);
326
    TEST_JCC("ae", 1, 0);
327
    TEST_JCC("ae", 1, -1);
328

    
329
    TEST_JCC("a", 1, 1);
330
    TEST_JCC("a", 1, 0);
331
    TEST_JCC("a", 1, -1);
332

    
333

    
334
    TEST_JCC("p", 1, 1);
335
    TEST_JCC("p", 1, 0);
336

    
337
    TEST_JCC("np", 1, 1);
338
    TEST_JCC("np", 1, 0);
339

    
340
    TEST_JCC("o", 0x7fffffff, 0);
341
    TEST_JCC("o", 0x7fffffff, -1);
342

    
343
    TEST_JCC("no", 0x7fffffff, 0);
344
    TEST_JCC("no", 0x7fffffff, -1);
345

    
346
    TEST_JCC("s", 0, 1);
347
    TEST_JCC("s", 0, -1);
348
    TEST_JCC("s", 0, 0);
349

    
350
    TEST_JCC("ns", 0, 1);
351
    TEST_JCC("ns", 0, -1);
352
    TEST_JCC("ns", 0, 0);
353
}
354

    
355
#undef CC_MASK
356
#ifdef TEST_P4_FLAGS
357
#define CC_MASK (CC_C | CC_P | CC_Z | CC_S | CC_O | CC_A)
358
#else
359
#define CC_MASK (CC_O | CC_C)
360
#endif
361

    
362
#define OP mul
363
#include "test-i386-muldiv.h"
364

    
365
#define OP imul
366
#include "test-i386-muldiv.h"
367

    
368
void test_imulw2(int op0, int op1) 
369
{
370
    int res, s1, s0, flags;
371
    s0 = op0;
372
    s1 = op1;
373
    res = s0;
374
    flags = 0;
375
    asm ("push %4\n\t"
376
         "popf\n\t"
377
         "imulw %w2, %w0\n\t" 
378
         "pushf\n\t"
379
         "popl %1\n\t"
380
         : "=q" (res), "=g" (flags)
381
         : "q" (s1), "0" (res), "1" (flags));
382
    printf("%-10s A=%08x B=%08x R=%08x CC=%04x\n",
383
           "imulw", s0, s1, res, flags & CC_MASK);
384
}
385

    
386
void test_imull2(int op0, int op1) 
387
{
388
    int res, s1, s0, flags;
389
    s0 = op0;
390
    s1 = op1;
391
    res = s0;
392
    flags = 0;
393
    asm ("push %4\n\t"
394
         "popf\n\t"
395
         "imull %2, %0\n\t" 
396
         "pushf\n\t"
397
         "popl %1\n\t"
398
         : "=q" (res), "=g" (flags)
399
         : "q" (s1), "0" (res), "1" (flags));
400
    printf("%-10s A=%08x B=%08x R=%08x CC=%04x\n",
401
           "imull", s0, s1, res, flags & CC_MASK);
402
}
403

    
404
#undef CC_MASK
405
#define CC_MASK (0)
406

    
407
#define OP div
408
#include "test-i386-muldiv.h"
409

    
410
#define OP idiv
411
#include "test-i386-muldiv.h"
412

    
413
void test_mul(void)
414
{
415
    test_imulb(0x1234561d, 4);
416
    test_imulb(3, -4);
417
    test_imulb(0x80, 0x80);
418
    test_imulb(0x10, 0x10);
419

    
420
    test_imulw(0, 0x1234001d, 45);
421
    test_imulw(0, 23, -45);
422
    test_imulw(0, 0x8000, 0x8000);
423
    test_imulw(0, 0x100, 0x100);
424

    
425
    test_imull(0, 0x1234001d, 45);
426
    test_imull(0, 23, -45);
427
    test_imull(0, 0x80000000, 0x80000000);
428
    test_imull(0, 0x10000, 0x10000);
429

    
430
    test_mulb(0x1234561d, 4);
431
    test_mulb(3, -4);
432
    test_mulb(0x80, 0x80);
433
    test_mulb(0x10, 0x10);
434

    
435
    test_mulw(0, 0x1234001d, 45);
436
    test_mulw(0, 23, -45);
437
    test_mulw(0, 0x8000, 0x8000);
438
    test_mulw(0, 0x100, 0x100);
439

    
440
    test_mull(0, 0x1234001d, 45);
441
    test_mull(0, 23, -45);
442
    test_mull(0, 0x80000000, 0x80000000);
443
    test_mull(0, 0x10000, 0x10000);
444

    
445
    test_imulw2(0x1234001d, 45);
446
    test_imulw2(23, -45);
447
    test_imulw2(0x8000, 0x8000);
448
    test_imulw2(0x100, 0x100);
449

    
450
    test_imull2(0x1234001d, 45);
451
    test_imull2(23, -45);
452
    test_imull2(0x80000000, 0x80000000);
453
    test_imull2(0x10000, 0x10000);
454

    
455
    test_idivb(0x12341678, 0x127e);
456
    test_idivb(0x43210123, -5);
457
    test_idivb(0x12340004, -1);
458

    
459
    test_idivw(0, 0x12345678, 12347);
460
    test_idivw(0, -23223, -45);
461
    test_idivw(0, 0x12348000, -1);
462
    test_idivw(0x12343, 0x12345678, 0x81238567);
463

    
464
    test_idivl(0, 0x12345678, 12347);
465
    test_idivl(0, -233223, -45);
466
    test_idivl(0, 0x80000000, -1);
467
    test_idivl(0x12343, 0x12345678, 0x81234567);
468

    
469
    test_divb(0x12341678, 0x127e);
470
    test_divb(0x43210123, -5);
471
    test_divb(0x12340004, -1);
472

    
473
    test_divw(0, 0x12345678, 12347);
474
    test_divw(0, -23223, -45);
475
    test_divw(0, 0x12348000, -1);
476
    test_divw(0x12343, 0x12345678, 0x81238567);
477

    
478
    test_divl(0, 0x12345678, 12347);
479
    test_divl(0, -233223, -45);
480
    test_divl(0, 0x80000000, -1);
481
    test_divl(0x12343, 0x12345678, 0x81234567);
482
}
483

    
484
#define TEST_BSX(op, size, op0)\
485
{\
486
    int res, val, resz;\
487
    val = op0;\
488
    asm("xorl %1, %1 ; " #op " %" size "2, %" size "0 ; setz %b1" \
489
        : "=r" (res), "=q" (resz)\
490
        : "g" (val));\
491
    printf("%-10s A=%08x R=%08x %d\n", #op, val, resz ? 0 : res, resz);\
492
}
493

    
494
void test_bsx(void)
495
{
496
    TEST_BSX(bsrw, "w", 0);
497
    TEST_BSX(bsrw, "w", 0x12340128);
498
    TEST_BSX(bsrl, "", 0);
499
    TEST_BSX(bsrl, "", 0x00340128);
500
    TEST_BSX(bsfw, "w", 0);
501
    TEST_BSX(bsfw, "w", 0x12340128);
502
    TEST_BSX(bsfl, "", 0);
503
    TEST_BSX(bsfl, "", 0x00340128);
504
}
505

    
506
/**********************************************/
507

    
508
void test_fops(double a, double b)
509
{
510
    printf("a=%f b=%f a+b=%f\n", a, b, a + b);
511
    printf("a=%f b=%f a-b=%f\n", a, b, a - b);
512
    printf("a=%f b=%f a*b=%f\n", a, b, a * b);
513
    printf("a=%f b=%f a/b=%f\n", a, b, a / b);
514
    printf("a=%f b=%f fmod(a, b)=%f\n", a, b, fmod(a, b));
515
    printf("a=%f sqrt(a)=%f\n", a, sqrt(a));
516
    printf("a=%f sin(a)=%f\n", a, sin(a));
517
    printf("a=%f cos(a)=%f\n", a, cos(a));
518
    printf("a=%f tan(a)=%f\n", a, tan(a));
519
    printf("a=%f log(a)=%f\n", a, log(a));
520
    printf("a=%f exp(a)=%f\n", a, exp(a));
521
    printf("a=%f b=%f atan2(a, b)=%f\n", a, b, atan2(a, b));
522
    /* just to test some op combining */
523
    printf("a=%f asin(sin(a))=%f\n", a, asin(sin(a)));
524
    printf("a=%f acos(cos(a))=%f\n", a, acos(cos(a)));
525
    printf("a=%f atan(tan(a))=%f\n", a, atan(tan(a)));
526

    
527
}
528

    
529
void test_fcmp(double a, double b)
530
{
531
    printf("(%f<%f)=%d\n",
532
           a, b, a < b);
533
    printf("(%f<=%f)=%d\n",
534
           a, b, a <= b);
535
    printf("(%f==%f)=%d\n",
536
           a, b, a == b);
537
    printf("(%f>%f)=%d\n",
538
           a, b, a > b);
539
    printf("(%f<=%f)=%d\n",
540
           a, b, a >= b);
541
    if (TEST_FCOMI) {
542
        unsigned int eflags;
543
        /* test f(u)comi instruction */
544
        asm("fcomi %2, %1\n"
545
            "pushf\n"
546
            "pop %0\n"
547
            : "=r" (eflags)
548
            : "t" (a), "u" (b));
549
        printf("fcomi(%f %f)=%08x\n", a, b, eflags & (CC_Z | CC_P | CC_C));
550
    }
551
}
552

    
553
void test_fcvt(double a)
554
{
555
    float fa;
556
    long double la;
557
    int16_t fpuc;
558
    int i;
559
    int64_t lla;
560
    int ia;
561
    int16_t wa;
562
    double ra;
563

    
564
    fa = a;
565
    la = a;
566
    printf("(float)%f = %f\n", a, fa);
567
    printf("(long double)%f = %Lf\n", a, la);
568
    printf("a=%016Lx\n", *(long long *)&a);
569
    printf("la=%016Lx %04x\n", *(long long *)&la, 
570
           *(unsigned short *)((char *)(&la) + 8));
571

    
572
    /* test all roundings */
573
    asm volatile ("fstcw %0" : "=m" (fpuc));
574
    for(i=0;i<4;i++) {
575
        asm volatile ("fldcw %0" : : "m" ((fpuc & ~0x0c00) | (i << 10)));
576
        asm volatile ("fist %0" : "=m" (wa) : "t" (a));
577
        asm volatile ("fistl %0" : "=m" (ia) : "t" (a));
578
        asm volatile ("fistpll %0" : "=m" (lla) : "t" (a) : "st");
579
        asm volatile ("frndint ; fstl %0" : "=m" (ra) : "t" (a));
580
        asm volatile ("fldcw %0" : : "m" (fpuc));
581
        printf("(short)a = %d\n", wa);
582
        printf("(int)a = %d\n", ia);
583
        printf("(int64_t)a = %Ld\n", lla);
584
        printf("rint(a) = %f\n", ra);
585
    }
586
}
587

    
588
#define TEST(N) \
589
    asm("fld" #N : "=t" (a)); \
590
    printf("fld" #N "= %f\n", a);
591

    
592
void test_fconst(void)
593
{
594
    double a;
595
    TEST(1);
596
    TEST(l2t);
597
    TEST(l2e);
598
    TEST(pi);
599
    TEST(lg2);
600
    TEST(ln2);
601
    TEST(z);
602
}
603

    
604
void test_fbcd(double a)
605
{
606
    unsigned short bcd[5];
607
    double b;
608

    
609
    asm("fbstp %0" : "=m" (bcd[0]) : "t" (a) : "st");
610
    asm("fbld %1" : "=t" (b) : "m" (bcd[0]));
611
    printf("a=%f bcd=%04x%04x%04x%04x%04x b=%f\n", 
612
           a, bcd[4], bcd[3], bcd[2], bcd[1], bcd[0], b);
613
}
614

    
615
#define TEST_ENV(env, prefix)\
616
{\
617
    memset((env), 0xaa, sizeof(*(env)));\
618
    asm("fld1\n"\
619
        prefix "fnstenv %1\n"\
620
        prefix "fldenv %1\n"\
621
        : "=t" (res) : "m" (*(env)));\
622
    printf("res=%f\n", res);\
623
    printf("fpuc=%04x fpus=%04x fptag=%04x\n",\
624
           (env)->fpuc,\
625
           (env)->fpus & 0xff00,\
626
           (env)->fptag);\
627
    memset((env), 0xaa, sizeof(*(env)));\
628
    asm("fld1\n"\
629
        prefix "fnsave %1\n"\
630
        prefix "frstor %1\n"\
631
        : "=t" (res) : "m" (*(env)));\
632
    printf("res=%f\n", res);\
633
    printf("fpuc=%04x fpus=%04x fptag=%04x\n",\
634
           (env)->fpuc,\
635
           (env)->fpus & 0xff00,\
636
           (env)->fptag);\
637
    printf("ST(0) = %Lf\n",\
638
           (env)->fpregs[0]);\
639
}
640

    
641
void test_fenv(void)
642
{
643
    struct __attribute__((packed)) {
644
        uint16_t fpuc;
645
        uint16_t dummy1;
646
        uint16_t fpus;
647
        uint16_t dummy2;
648
        uint16_t fptag;
649
        uint16_t dummy3;
650
        uint32_t ignored[4];
651
        long double fpregs[8];
652
    } float_env32;
653
    struct __attribute__((packed)) {
654
        uint16_t fpuc;
655
        uint16_t fpus;
656
        uint16_t fptag;
657
        uint16_t ignored[4];
658
        long double fpregs[8];
659
    } float_env16;
660
    double res;
661

    
662
    TEST_ENV(&float_env16, "data16 ");
663
    TEST_ENV(&float_env32, "");
664
}
665

    
666

    
667
#define TEST_FCMOV(a, b, eflags, CC)\
668
{\
669
    double res;\
670
    asm("push %3\n"\
671
        "popf\n"\
672
        "fcmov" CC " %2, %0\n"\
673
        : "=t" (res)\
674
        : "0" (a), "u" (b), "g" (eflags));\
675
    printf("fcmov%s eflags=0x%04x-> %f\n", \
676
           CC, eflags, res);\
677
}
678

    
679
void test_fcmov(void)
680
{
681
    double a, b;
682
    int eflags, i;
683

    
684
    a = 1.0;
685
    b = 2.0;
686
    for(i = 0; i < 4; i++) {
687
        eflags = 0;
688
        if (i & 1)
689
            eflags |= CC_C;
690
        if (i & 2)
691
            eflags |= CC_Z;
692
        TEST_FCMOV(a, b, eflags, "b");
693
        TEST_FCMOV(a, b, eflags, "e");
694
        TEST_FCMOV(a, b, eflags, "be");
695
        TEST_FCMOV(a, b, eflags, "nb");
696
        TEST_FCMOV(a, b, eflags, "ne");
697
        TEST_FCMOV(a, b, eflags, "nbe");
698
    }
699
    TEST_FCMOV(a, b, 0, "u");
700
    TEST_FCMOV(a, b, CC_P, "u");
701
    TEST_FCMOV(a, b, 0, "nu");
702
    TEST_FCMOV(a, b, CC_P, "nu");
703
}
704

    
705
void test_floats(void)
706
{
707
    test_fops(2, 3);
708
    test_fops(1.4, -5);
709
    test_fcmp(2, -1);
710
    test_fcmp(2, 2);
711
    test_fcmp(2, 3);
712
    test_fcvt(0.5);
713
    test_fcvt(-0.5);
714
    test_fcvt(1.0/7.0);
715
    test_fcvt(-1.0/9.0);
716
    test_fcvt(32768);
717
    test_fcvt(-1e20);
718
    test_fconst();
719
    test_fbcd(1234567890123456);
720
    test_fbcd(-123451234567890);
721
    test_fenv();
722
    if (TEST_CMOV) {
723
        test_fcmov();
724
    }
725
}
726

    
727
/**********************************************/
728

    
729
#define TEST_BCD(op, op0, cc_in, cc_mask)\
730
{\
731
    int res, flags;\
732
    res = op0;\
733
    flags = cc_in;\
734
    asm ("push %3\n\t"\
735
         "popf\n\t"\
736
         #op "\n\t"\
737
         "pushf\n\t"\
738
         "popl %1\n\t"\
739
        : "=a" (res), "=g" (flags)\
740
        : "0" (res), "1" (flags));\
741
    printf("%-10s A=%08x R=%08x CCIN=%04x CC=%04x\n",\
742
           #op, op0, res, cc_in, flags & cc_mask);\
743
}
744

    
745
void test_bcd(void)
746
{
747
    TEST_BCD(daa, 0x12340503, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
748
    TEST_BCD(daa, 0x12340506, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
749
    TEST_BCD(daa, 0x12340507, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
750
    TEST_BCD(daa, 0x12340559, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
751
    TEST_BCD(daa, 0x12340560, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
752
    TEST_BCD(daa, 0x1234059f, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
753
    TEST_BCD(daa, 0x123405a0, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
754
    TEST_BCD(daa, 0x12340503, 0, (CC_C | CC_P | CC_Z | CC_S | CC_A));
755
    TEST_BCD(daa, 0x12340506, 0, (CC_C | CC_P | CC_Z | CC_S | CC_A));
756
    TEST_BCD(daa, 0x12340503, CC_C, (CC_C | CC_P | CC_Z | CC_S | CC_A));
757
    TEST_BCD(daa, 0x12340506, CC_C, (CC_C | CC_P | CC_Z | CC_S | CC_A));
758
    TEST_BCD(daa, 0x12340503, CC_C | CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
759
    TEST_BCD(daa, 0x12340506, CC_C | CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
760

    
761
    TEST_BCD(das, 0x12340503, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
762
    TEST_BCD(das, 0x12340506, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
763
    TEST_BCD(das, 0x12340507, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
764
    TEST_BCD(das, 0x12340559, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
765
    TEST_BCD(das, 0x12340560, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
766
    TEST_BCD(das, 0x1234059f, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
767
    TEST_BCD(das, 0x123405a0, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
768
    TEST_BCD(das, 0x12340503, 0, (CC_C | CC_P | CC_Z | CC_S | CC_A));
769
    TEST_BCD(das, 0x12340506, 0, (CC_C | CC_P | CC_Z | CC_S | CC_A));
770
    TEST_BCD(das, 0x12340503, CC_C, (CC_C | CC_P | CC_Z | CC_S | CC_A));
771
    TEST_BCD(das, 0x12340506, CC_C, (CC_C | CC_P | CC_Z | CC_S | CC_A));
772
    TEST_BCD(das, 0x12340503, CC_C | CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
773
    TEST_BCD(das, 0x12340506, CC_C | CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_A));
774

    
775
    TEST_BCD(aaa, 0x12340205, CC_A, (CC_C | CC_A));
776
    TEST_BCD(aaa, 0x12340306, CC_A, (CC_C | CC_A));
777
    TEST_BCD(aaa, 0x1234040a, CC_A, (CC_C | CC_A));
778
    TEST_BCD(aaa, 0x123405fa, CC_A, (CC_C | CC_A));
779
    TEST_BCD(aaa, 0x12340205, 0, (CC_C | CC_A));
780
    TEST_BCD(aaa, 0x12340306, 0, (CC_C | CC_A));
781
    TEST_BCD(aaa, 0x1234040a, 0, (CC_C | CC_A));
782
    TEST_BCD(aaa, 0x123405fa, 0, (CC_C | CC_A));
783
    
784
    TEST_BCD(aas, 0x12340205, CC_A, (CC_C | CC_A));
785
    TEST_BCD(aas, 0x12340306, CC_A, (CC_C | CC_A));
786
    TEST_BCD(aas, 0x1234040a, CC_A, (CC_C | CC_A));
787
    TEST_BCD(aas, 0x123405fa, CC_A, (CC_C | CC_A));
788
    TEST_BCD(aas, 0x12340205, 0, (CC_C | CC_A));
789
    TEST_BCD(aas, 0x12340306, 0, (CC_C | CC_A));
790
    TEST_BCD(aas, 0x1234040a, 0, (CC_C | CC_A));
791
    TEST_BCD(aas, 0x123405fa, 0, (CC_C | CC_A));
792

    
793
    TEST_BCD(aam, 0x12340547, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_O | CC_A));
794
    TEST_BCD(aad, 0x12340407, CC_A, (CC_C | CC_P | CC_Z | CC_S | CC_O | CC_A));
795
}
796

    
797
#define TEST_XCHG(op, size, opconst)\
798
{\
799
    int op0, op1;\
800
    op0 = 0x12345678;\
801
    op1 = 0xfbca7654;\
802
    asm(#op " %" size "0, %" size "1" \
803
        : "=q" (op0), opconst (op1) \
804
        : "0" (op0), "1" (op1));\
805
    printf("%-10s A=%08x B=%08x\n",\
806
           #op, op0, op1);\
807
}
808

    
809
#define TEST_CMPXCHG(op, size, opconst, eax)\
810
{\
811
    int op0, op1;\
812
    op0 = 0x12345678;\
813
    op1 = 0xfbca7654;\
814
    asm(#op " %" size "0, %" size "1" \
815
        : "=q" (op0), opconst (op1) \
816
        : "0" (op0), "1" (op1), "a" (eax));\
817
    printf("%-10s EAX=%08x A=%08x C=%08x\n",\
818
           #op, eax, op0, op1);\
819
}
820

    
821
void test_xchg(void)
822
{
823
    TEST_XCHG(xchgl, "", "=q");
824
    TEST_XCHG(xchgw, "w", "=q");
825
    TEST_XCHG(xchgb, "b", "=q");
826

    
827
    TEST_XCHG(xchgl, "", "=m");
828
    TEST_XCHG(xchgw, "w", "=m");
829
    TEST_XCHG(xchgb, "b", "=m");
830

    
831
    TEST_XCHG(xaddl, "", "=q");
832
    TEST_XCHG(xaddw, "w", "=q");
833
    TEST_XCHG(xaddb, "b", "=q");
834

    
835
    {
836
        int res;
837
        res = 0x12345678;
838
        asm("xaddl %1, %0" : "=r" (res) : "0" (res));
839
        printf("xaddl same res=%08x\n", res);
840
    }
841

    
842
    TEST_XCHG(xaddl, "", "=m");
843
    TEST_XCHG(xaddw, "w", "=m");
844
    TEST_XCHG(xaddb, "b", "=m");
845

    
846
    TEST_CMPXCHG(cmpxchgl, "", "=q", 0xfbca7654);
847
    TEST_CMPXCHG(cmpxchgw, "w", "=q", 0xfbca7654);
848
    TEST_CMPXCHG(cmpxchgb, "b", "=q", 0xfbca7654);
849

    
850
    TEST_CMPXCHG(cmpxchgl, "", "=q", 0xfffefdfc);
851
    TEST_CMPXCHG(cmpxchgw, "w", "=q", 0xfffefdfc);
852
    TEST_CMPXCHG(cmpxchgb, "b", "=q", 0xfffefdfc);
853

    
854
    TEST_CMPXCHG(cmpxchgl, "", "=m", 0xfbca7654);
855
    TEST_CMPXCHG(cmpxchgw, "w", "=m", 0xfbca7654);
856
    TEST_CMPXCHG(cmpxchgb, "b", "=m", 0xfbca7654);
857

    
858
    TEST_CMPXCHG(cmpxchgl, "", "=m", 0xfffefdfc);
859
    TEST_CMPXCHG(cmpxchgw, "w", "=m", 0xfffefdfc);
860
    TEST_CMPXCHG(cmpxchgb, "b", "=m", 0xfffefdfc);
861

    
862
    {
863
        uint64_t op0, op1, op2;
864
        int i, eflags;
865

    
866
        for(i = 0; i < 2; i++) {
867
            op0 = 0x123456789abcd;
868
            if (i == 0)
869
                op1 = 0xfbca765423456;
870
            else
871
                op1 = op0;
872
            op2 = 0x6532432432434;
873
            asm("cmpxchg8b %1\n" 
874
                "pushf\n"
875
                "popl %2\n"
876
                : "=A" (op0), "=m" (op1), "=g" (eflags)
877
                : "0" (op0), "m" (op1), "b" ((int)op2), "c" ((int)(op2 >> 32)));
878
            printf("cmpxchg8b: op0=%016llx op1=%016llx CC=%02x\n", 
879
                    op0, op1, eflags & CC_Z);
880
        }
881
    }
882
}
883

    
884
/**********************************************/
885
/* segmentation tests */
886

    
887
#include <asm/ldt.h>
888
#include <linux/unistd.h>
889

    
890
_syscall3(int, modify_ldt, int, func, void *, ptr, unsigned long, bytecount)
891

    
892
uint8_t seg_data1[4096];
893
uint8_t seg_data2[4096];
894

    
895
#define MK_SEL(n) (((n) << 3) | 7)
896

    
897
#define TEST_LR(op, size, seg, mask)\
898
{\
899
    int res, res2;\
900
    res = 0x12345678;\
901
    asm (op " %" size "2, %" size "0\n" \
902
         "movl $0, %1\n"\
903
         "jnz 1f\n"\
904
         "movl $1, %1\n"\
905
         "1:\n"\
906
         : "=r" (res), "=r" (res2) : "m" (seg), "0" (res));\
907
    printf(op ": Z=%d %08x\n", res2, res & ~(mask));\
908
}
909

    
910
/* NOTE: we use Linux modify_ldt syscall */
911
void test_segs(void)
912
{
913
    struct modify_ldt_ldt_s ldt;
914
    long long ldt_table[3];
915
    int res, res2;
916
    char tmp;
917
    struct {
918
        uint32_t offset;
919
        uint16_t seg;
920
    } __attribute__((packed)) segoff;
921

    
922
    ldt.entry_number = 1;
923
    ldt.base_addr = (unsigned long)&seg_data1;
924
    ldt.limit = (sizeof(seg_data1) + 0xfff) >> 12;
925
    ldt.seg_32bit = 1;
926
    ldt.contents = MODIFY_LDT_CONTENTS_DATA;
927
    ldt.read_exec_only = 0;
928
    ldt.limit_in_pages = 1;
929
    ldt.seg_not_present = 0;
930
    ldt.useable = 1;
931
    modify_ldt(1, &ldt, sizeof(ldt)); /* write ldt entry */
932

    
933
    ldt.entry_number = 2;
934
    ldt.base_addr = (unsigned long)&seg_data2;
935
    ldt.limit = (sizeof(seg_data2) + 0xfff) >> 12;
936
    ldt.seg_32bit = 1;
937
    ldt.contents = MODIFY_LDT_CONTENTS_DATA;
938
    ldt.read_exec_only = 0;
939
    ldt.limit_in_pages = 1;
940
    ldt.seg_not_present = 0;
941
    ldt.useable = 1;
942
    modify_ldt(1, &ldt, sizeof(ldt)); /* write ldt entry */
943

    
944
    modify_ldt(0, &ldt_table, sizeof(ldt_table)); /* read ldt entries */
945
#if 0
946
    {
947
        int i;
948
        for(i=0;i<3;i++)
949
            printf("%d: %016Lx\n", i, ldt_table[i]);
950
    }
951
#endif
952
    /* do some tests with fs or gs */
953
    asm volatile ("movl %0, %%fs" : : "r" (MK_SEL(1)));
954

    
955
    seg_data1[1] = 0xaa;
956
    seg_data2[1] = 0x55;
957

    
958
    asm volatile ("fs movzbl 0x1, %0" : "=r" (res));
959
    printf("FS[1] = %02x\n", res);
960

    
961
    asm volatile ("pushl %%gs\n"
962
                  "movl %1, %%gs\n"
963
                  "gs movzbl 0x1, %0\n"
964
                  "popl %%gs\n"
965
                  : "=r" (res)
966
                  : "r" (MK_SEL(2)));
967
    printf("GS[1] = %02x\n", res);
968

    
969
    /* tests with ds/ss (implicit segment case) */
970
    tmp = 0xa5;
971
    asm volatile ("pushl %%ebp\n\t"
972
                  "pushl %%ds\n\t"
973
                  "movl %2, %%ds\n\t"
974
                  "movl %3, %%ebp\n\t"
975
                  "movzbl 0x1, %0\n\t"
976
                  "movzbl (%%ebp), %1\n\t"
977
                  "popl %%ds\n\t"
978
                  "popl %%ebp\n\t"
979
                  : "=r" (res), "=r" (res2)
980
                  : "r" (MK_SEL(1)), "r" (&tmp));
981
    printf("DS[1] = %02x\n", res);
982
    printf("SS[tmp] = %02x\n", res2);
983

    
984
    segoff.seg = MK_SEL(2);
985
    segoff.offset = 0xabcdef12;
986
    asm volatile("lfs %2, %0\n\t" 
987
                 "movl %%fs, %1\n\t"
988
                 : "=r" (res), "=g" (res2) 
989
                 : "m" (segoff));
990
    printf("FS:reg = %04x:%08x\n", res2, res);
991

    
992
    TEST_LR("larw", "w", MK_SEL(2), 0x0100);
993
    TEST_LR("larl", "", MK_SEL(2), 0x0100);
994
    TEST_LR("lslw", "w", MK_SEL(2), 0);
995
    TEST_LR("lsll", "", MK_SEL(2), 0);
996

    
997
    TEST_LR("larw", "w", 0xfff8, 0);
998
    TEST_LR("larl", "", 0xfff8, 0);
999
    TEST_LR("lslw", "w", 0xfff8, 0);
1000
    TEST_LR("lsll", "", 0xfff8, 0);
1001
}
1002

    
1003
/* 16 bit code test */
1004
extern char code16_start, code16_end;
1005
extern char code16_func1;
1006
extern char code16_func2;
1007
extern char code16_func3;
1008

    
1009
void test_code16(void)
1010
{
1011
    struct modify_ldt_ldt_s ldt;
1012
    int res, res2;
1013

    
1014
    /* build a code segment */
1015
    ldt.entry_number = 1;
1016
    ldt.base_addr = (unsigned long)&code16_start;
1017
    ldt.limit = &code16_end - &code16_start;
1018
    ldt.seg_32bit = 0;
1019
    ldt.contents = MODIFY_LDT_CONTENTS_CODE;
1020
    ldt.read_exec_only = 0;
1021
    ldt.limit_in_pages = 0;
1022
    ldt.seg_not_present = 0;
1023
    ldt.useable = 1;
1024
    modify_ldt(1, &ldt, sizeof(ldt)); /* write ldt entry */
1025

    
1026
    /* call the first function */
1027
    asm volatile ("lcall %1, %2" 
1028
                  : "=a" (res)
1029
                  : "i" (MK_SEL(1)), "i" (&code16_func1): "memory", "cc");
1030
    printf("func1() = 0x%08x\n", res);
1031
    asm volatile ("lcall %2, %3" 
1032
                  : "=a" (res), "=c" (res2)
1033
                  : "i" (MK_SEL(1)), "i" (&code16_func2): "memory", "cc");
1034
    printf("func2() = 0x%08x spdec=%d\n", res, res2);
1035
    asm volatile ("lcall %1, %2" 
1036
                  : "=a" (res)
1037
                  : "i" (MK_SEL(1)), "i" (&code16_func3): "memory", "cc");
1038
    printf("func3() = 0x%08x\n", res);
1039
}
1040

    
1041
extern char func_lret32;
1042
extern char func_iret32;
1043

    
1044
void test_misc(void)
1045
{
1046
    char table[256];
1047
    int res, i;
1048

    
1049
    for(i=0;i<256;i++) table[i] = 256 - i;
1050
    res = 0x12345678;
1051
    asm ("xlat" : "=a" (res) : "b" (table), "0" (res));
1052
    printf("xlat: EAX=%08x\n", res);
1053

    
1054
    asm volatile ("pushl %%cs ; call %1" 
1055
                  : "=a" (res)
1056
                  : "m" (func_lret32): "memory", "cc");
1057
    printf("func_lret32=%x\n", res);
1058

    
1059
    asm volatile ("pushfl ; pushl %%cs ; call %1" 
1060
                  : "=a" (res)
1061
                  : "m" (func_iret32): "memory", "cc");
1062
    printf("func_iret32=%x\n", res);
1063

    
1064
    /* specific popl test */
1065
    asm volatile ("pushl $12345432 ; pushl $0x9abcdef ; popl (%%esp) ; popl %0"
1066
                  : "=g" (res));
1067
    printf("popl esp=%x\n", res);
1068

    
1069
    /* specific popw test */
1070
    asm volatile ("pushl $12345432 ; pushl $0x9abcdef ; popw (%%esp) ; addl $2, %%esp ; popl %0"
1071
                  : "=g" (res));
1072
    printf("popw esp=%x\n", res);
1073
}
1074

    
1075
uint8_t str_buffer[4096];
1076

    
1077
#define TEST_STRING1(OP, size, DF, REP)\
1078
{\
1079
    int esi, edi, eax, ecx, eflags;\
1080
\
1081
    esi = (long)(str_buffer + sizeof(str_buffer) / 2);\
1082
    edi = (long)(str_buffer + sizeof(str_buffer) / 2) + 16;\
1083
    eax = 0x12345678;\
1084
    ecx = 17;\
1085
\
1086
    asm volatile ("pushl $0\n\t"\
1087
                  "popf\n\t"\
1088
                  DF "\n\t"\
1089
                  REP #OP size "\n\t"\
1090
                  "cld\n\t"\
1091
                  "pushf\n\t"\
1092
                  "popl %4\n\t"\
1093
                  : "=S" (esi), "=D" (edi), "=a" (eax), "=c" (ecx), "=g" (eflags)\
1094
                  : "0" (esi), "1" (edi), "2" (eax), "3" (ecx));\
1095
    printf("%-10s ESI=%08x EDI=%08x EAX=%08x ECX=%08x EFL=%04x\n",\
1096
           REP #OP size, esi, edi, eax, ecx,\
1097
           eflags & (CC_C | CC_P | CC_Z | CC_S | CC_O | CC_A));\
1098
}
1099

    
1100
#define TEST_STRING(OP, REP)\
1101
    TEST_STRING1(OP, "b", "", REP);\
1102
    TEST_STRING1(OP, "w", "", REP);\
1103
    TEST_STRING1(OP, "l", "", REP);\
1104
    TEST_STRING1(OP, "b", "std", REP);\
1105
    TEST_STRING1(OP, "w", "std", REP);\
1106
    TEST_STRING1(OP, "l", "std", REP)
1107

    
1108
void test_string(void)
1109
{
1110
    int i;
1111
    for(i = 0;i < sizeof(str_buffer); i++)
1112
        str_buffer[i] = i + 0x56;
1113
   TEST_STRING(stos, "");
1114
   TEST_STRING(stos, "rep ");
1115
   TEST_STRING(lods, ""); /* to verify stos */
1116
   TEST_STRING(lods, "rep "); 
1117
   TEST_STRING(movs, "");
1118
   TEST_STRING(movs, "rep ");
1119
   TEST_STRING(lods, ""); /* to verify stos */
1120

    
1121
   /* XXX: better tests */
1122
   TEST_STRING(scas, "");
1123
   TEST_STRING(scas, "repz ");
1124
   TEST_STRING(scas, "repnz ");
1125
   TEST_STRING(cmps, "");
1126
   TEST_STRING(cmps, "repz ");
1127
   TEST_STRING(cmps, "repnz ");
1128
}
1129

    
1130
/* VM86 test */
1131

    
1132
static inline void set_bit(uint8_t *a, unsigned int bit)
1133
{
1134
    a[bit / 8] |= (1 << (bit % 8));
1135
}
1136

    
1137
static inline uint8_t *seg_to_linear(unsigned int seg, unsigned int reg)
1138
{
1139
    return (uint8_t *)((seg << 4) + (reg & 0xffff));
1140
}
1141

    
1142
static inline void pushw(struct vm86_regs *r, int val)
1143
{
1144
    r->esp = (r->esp & ~0xffff) | ((r->esp - 2) & 0xffff);
1145
    *(uint16_t *)seg_to_linear(r->ss, r->esp) = val;
1146
}
1147

    
1148
#undef __syscall_return
1149
#define __syscall_return(type, res) \
1150
do { \
1151
        return (type) (res); \
1152
} while (0)
1153

    
1154
_syscall2(int, vm86, int, func, struct vm86plus_struct *, v86)
1155

    
1156
extern char vm86_code_start;
1157
extern char vm86_code_end;
1158

    
1159
#define VM86_CODE_CS 0x100
1160
#define VM86_CODE_IP 0x100
1161

    
1162
void test_vm86(void)
1163
{
1164
    struct vm86plus_struct ctx;
1165
    struct vm86_regs *r;
1166
    uint8_t *vm86_mem;
1167
    int seg, ret;
1168

    
1169
    vm86_mem = mmap((void *)0x00000000, 0x110000, 
1170
                    PROT_WRITE | PROT_READ | PROT_EXEC, 
1171
                    MAP_FIXED | MAP_ANON | MAP_PRIVATE, -1, 0);
1172
    if (vm86_mem == MAP_FAILED) {
1173
        printf("ERROR: could not map vm86 memory");
1174
        return;
1175
    }
1176
    memset(&ctx, 0, sizeof(ctx));
1177

    
1178
    /* init basic registers */
1179
    r = &ctx.regs;
1180
    r->eip = VM86_CODE_IP;
1181
    r->esp = 0xfffe;
1182
    seg = VM86_CODE_CS;
1183
    r->cs = seg;
1184
    r->ss = seg;
1185
    r->ds = seg;
1186
    r->es = seg;
1187
    r->fs = seg;
1188
    r->gs = seg;
1189
    r->eflags = VIF_MASK;
1190

    
1191
    /* move code to proper address. We use the same layout as a .com
1192
       dos program. */
1193
    memcpy(vm86_mem + (VM86_CODE_CS << 4) + VM86_CODE_IP, 
1194
           &vm86_code_start, &vm86_code_end - &vm86_code_start);
1195

    
1196
    /* mark int 0x21 as being emulated */
1197
    set_bit((uint8_t *)&ctx.int_revectored, 0x21);
1198

    
1199
    for(;;) {
1200
        ret = vm86(VM86_ENTER, &ctx);
1201
        switch(VM86_TYPE(ret)) {
1202
        case VM86_INTx:
1203
            {
1204
                int int_num, ah, v;
1205
                
1206
                int_num = VM86_ARG(ret);
1207
                if (int_num != 0x21)
1208
                    goto unknown_int;
1209
                ah = (r->eax >> 8) & 0xff;
1210
                switch(ah) {
1211
                case 0x00: /* exit */
1212
                    goto the_end;
1213
                case 0x02: /* write char */
1214
                    {
1215
                        uint8_t c = r->edx;
1216
                        putchar(c);
1217
                    }
1218
                    break;
1219
                case 0x09: /* write string */
1220
                    {
1221
                        uint8_t c, *ptr;
1222
                        ptr = seg_to_linear(r->ds, r->edx);
1223
                        for(;;) {
1224
                            c = *ptr++;
1225
                            if (c == '$')
1226
                                break;
1227
                            putchar(c);
1228
                        }
1229
                        r->eax = (r->eax & ~0xff) | '$';
1230
                    }
1231
                    break;
1232
                case 0xff: /* extension: write eflags number in edx */
1233
                    v = (int)r->edx;
1234
#ifndef LINUX_VM86_IOPL_FIX
1235
                    v &= ~0x3000;
1236
#endif
1237
                    printf("%08x\n", v);
1238
                    break;
1239
                default:
1240
                unknown_int:
1241
                    printf("unsupported int 0x%02x\n", int_num);
1242
                    goto the_end;
1243
                }
1244
            }
1245
            break;
1246
        case VM86_SIGNAL:
1247
            /* a signal came, we just ignore that */
1248
            break;
1249
        case VM86_STI:
1250
            break;
1251
        default:
1252
            printf("ERROR: unhandled vm86 return code (0x%x)\n", ret);
1253
            goto the_end;
1254
        }
1255
    }
1256
 the_end:
1257
    printf("VM86 end\n");
1258
    munmap(vm86_mem, 0x110000);
1259
}
1260

    
1261
/* exception tests */
1262
#ifndef REG_EAX
1263
#define REG_EAX EAX
1264
#define REG_EBX EBX
1265
#define REG_ECX ECX
1266
#define REG_EDX EDX
1267
#define REG_ESI ESI
1268
#define REG_EDI EDI
1269
#define REG_EBP EBP
1270
#define REG_ESP ESP
1271
#define REG_EIP EIP
1272
#define REG_EFL EFL
1273
#define REG_TRAPNO TRAPNO
1274
#define REG_ERR ERR
1275
#endif
1276

    
1277
jmp_buf jmp_env;
1278
int v1;
1279
int tab[2];
1280

    
1281
void sig_handler(int sig, siginfo_t *info, void *puc)
1282
{
1283
    struct ucontext *uc = puc;
1284

    
1285
    printf("si_signo=%d si_errno=%d si_code=%d",
1286
           info->si_signo, info->si_errno, info->si_code);
1287
    printf(" si_addr=0x%08lx",
1288
           (unsigned long)info->si_addr);
1289
    printf("\n");
1290

    
1291
    printf("trapno=0x%02x err=0x%08x",
1292
           uc->uc_mcontext.gregs[REG_TRAPNO],
1293
           uc->uc_mcontext.gregs[REG_ERR]);
1294
    printf(" EIP=0x%08x", uc->uc_mcontext.gregs[REG_EIP]);
1295
    printf("\n");
1296
    longjmp(jmp_env, 1);
1297
}
1298

    
1299
void test_exceptions(void)
1300
{
1301
    struct modify_ldt_ldt_s ldt;
1302
    struct sigaction act;
1303
    volatile int val;
1304
    
1305
    act.sa_sigaction = sig_handler;
1306
    sigemptyset(&act.sa_mask);
1307
    act.sa_flags = SA_SIGINFO;
1308
    sigaction(SIGFPE, &act, NULL);
1309
    sigaction(SIGILL, &act, NULL);
1310
    sigaction(SIGSEGV, &act, NULL);
1311
    sigaction(SIGBUS, &act, NULL);
1312
    sigaction(SIGTRAP, &act, NULL);
1313

    
1314
    /* test division by zero reporting */
1315
    printf("DIVZ exception:\n");
1316
    if (setjmp(jmp_env) == 0) {
1317
        /* now divide by zero */
1318
        v1 = 0;
1319
        v1 = 2 / v1;
1320
    }
1321

    
1322
    printf("BOUND exception:\n");
1323
    if (setjmp(jmp_env) == 0) {
1324
        /* bound exception */
1325
        tab[0] = 1;
1326
        tab[1] = 10;
1327
        asm volatile ("bound %0, %1" : : "r" (11), "m" (tab));
1328
    }
1329

    
1330
    printf("segment exceptions:\n");
1331
    if (setjmp(jmp_env) == 0) {
1332
        /* load an invalid segment */
1333
        asm volatile ("movl %0, %%fs" : : "r" ((0x1234 << 3) | 1));
1334
    }
1335
    if (setjmp(jmp_env) == 0) {
1336
        /* null data segment is valid */
1337
        asm volatile ("movl %0, %%fs" : : "r" (3));
1338
        /* null stack segment */
1339
        asm volatile ("movl %0, %%ss" : : "r" (3));
1340
    }
1341

    
1342
    ldt.entry_number = 1;
1343
    ldt.base_addr = (unsigned long)&seg_data1;
1344
    ldt.limit = (sizeof(seg_data1) + 0xfff) >> 12;
1345
    ldt.seg_32bit = 1;
1346
    ldt.contents = MODIFY_LDT_CONTENTS_DATA;
1347
    ldt.read_exec_only = 0;
1348
    ldt.limit_in_pages = 1;
1349
    ldt.seg_not_present = 1;
1350
    ldt.useable = 1;
1351
    modify_ldt(1, &ldt, sizeof(ldt)); /* write ldt entry */
1352

    
1353
    if (setjmp(jmp_env) == 0) {
1354
        /* segment not present */
1355
        asm volatile ("movl %0, %%fs" : : "r" (MK_SEL(1)));
1356
    }
1357

    
1358
    /* test SEGV reporting */
1359
    printf("PF exception:\n");
1360
    if (setjmp(jmp_env) == 0) {
1361
        val = 1;
1362
        /* we add a nop to test a weird PC retrieval case */
1363
        asm volatile ("nop");
1364
        /* now store in an invalid address */
1365
        *(char *)0x1234 = 1;
1366
    }
1367

    
1368
    /* test SEGV reporting */
1369
    printf("PF exception:\n");
1370
    if (setjmp(jmp_env) == 0) {
1371
        val = 1;
1372
        /* read from an invalid address */
1373
        v1 = *(char *)0x1234;
1374
    }
1375
    
1376
    /* test illegal instruction reporting */
1377
    printf("UD2 exception:\n");
1378
    if (setjmp(jmp_env) == 0) {
1379
        /* now execute an invalid instruction */
1380
        asm volatile("ud2");
1381
    }
1382
    printf("lock nop exception:\n");
1383
    if (setjmp(jmp_env) == 0) {
1384
        /* now execute an invalid instruction */
1385
        asm volatile("lock nop");
1386
    }
1387
    
1388
    printf("INT exception:\n");
1389
    if (setjmp(jmp_env) == 0) {
1390
        asm volatile ("int $0xfd");
1391
    }
1392
    if (setjmp(jmp_env) == 0) {
1393
        asm volatile ("int $0x01");
1394
    }
1395
    if (setjmp(jmp_env) == 0) {
1396
        asm volatile (".byte 0xcd, 0x03");
1397
    }
1398
    if (setjmp(jmp_env) == 0) {
1399
        asm volatile ("int $0x04");
1400
    }
1401
    if (setjmp(jmp_env) == 0) {
1402
        asm volatile ("int $0x05");
1403
    }
1404

    
1405
    printf("INT3 exception:\n");
1406
    if (setjmp(jmp_env) == 0) {
1407
        asm volatile ("int3");
1408
    }
1409

    
1410
    printf("CLI exception:\n");
1411
    if (setjmp(jmp_env) == 0) {
1412
        asm volatile ("cli");
1413
    }
1414

    
1415
    printf("STI exception:\n");
1416
    if (setjmp(jmp_env) == 0) {
1417
        asm volatile ("cli");
1418
    }
1419

    
1420
    printf("INTO exception:\n");
1421
    if (setjmp(jmp_env) == 0) {
1422
        /* overflow exception */
1423
        asm volatile ("addl $1, %0 ; into" : : "r" (0x7fffffff));
1424
    }
1425

    
1426
    printf("OUTB exception:\n");
1427
    if (setjmp(jmp_env) == 0) {
1428
        asm volatile ("outb %%al, %%dx" : : "d" (0x4321), "a" (0));
1429
    }
1430

    
1431
    printf("INB exception:\n");
1432
    if (setjmp(jmp_env) == 0) {
1433
        asm volatile ("inb %%dx, %%al" : "=a" (val) : "d" (0x4321));
1434
    }
1435

    
1436
    printf("REP OUTSB exception:\n");
1437
    if (setjmp(jmp_env) == 0) {
1438
        asm volatile ("rep outsb" : : "d" (0x4321), "S" (tab), "c" (1));
1439
    }
1440

    
1441
    printf("REP INSB exception:\n");
1442
    if (setjmp(jmp_env) == 0) {
1443
        asm volatile ("rep insb" : : "d" (0x4321), "D" (tab), "c" (1));
1444
    }
1445

    
1446
    printf("HLT exception:\n");
1447
    if (setjmp(jmp_env) == 0) {
1448
        asm volatile ("hlt");
1449
    }
1450

    
1451
    printf("single step exception:\n");
1452
    val = 0;
1453
    if (setjmp(jmp_env) == 0) {
1454
        asm volatile ("pushf\n"
1455
                      "orl $0x00100, (%%esp)\n"
1456
                      "popf\n"
1457
                      "movl $0xabcd, %0\n" 
1458
                      "movl $0x0, %0\n" : "=m" (val) : : "cc", "memory");
1459
    }
1460
    printf("val=0x%x\n", val);
1461
}
1462

    
1463
/* specific precise single step test */
1464
void sig_trap_handler(int sig, siginfo_t *info, void *puc)
1465
{
1466
    struct ucontext *uc = puc;
1467
    printf("EIP=0x%08x\n", uc->uc_mcontext.gregs[REG_EIP]);
1468
}
1469

    
1470
const uint8_t sstep_buf1[4] = { 1, 2, 3, 4};
1471
uint8_t sstep_buf2[4];
1472

    
1473
void test_single_step(void)
1474
{
1475
    struct sigaction act;
1476
    volatile int val;
1477
    int i;
1478

    
1479
    val = 0;
1480
    act.sa_sigaction = sig_trap_handler;
1481
    sigemptyset(&act.sa_mask);
1482
    act.sa_flags = SA_SIGINFO;
1483
    sigaction(SIGTRAP, &act, NULL);
1484
    asm volatile ("pushf\n"
1485
                  "orl $0x00100, (%%esp)\n"
1486
                  "popf\n"
1487
                  "movl $0xabcd, %0\n" 
1488

    
1489
                  /* jmp test */
1490
                  "movl $3, %%ecx\n"
1491
                  "1:\n"
1492
                  "addl $1, %0\n"
1493
                  "decl %%ecx\n"
1494
                  "jnz 1b\n"
1495

    
1496
                  /* movsb: the single step should stop at each movsb iteration */
1497
                  "movl $sstep_buf1, %%esi\n"
1498
                  "movl $sstep_buf2, %%edi\n"
1499
                  "movl $0, %%ecx\n"
1500
                  "rep movsb\n"
1501
                  "movl $3, %%ecx\n"
1502
                  "rep movsb\n"
1503
                  "movl $1, %%ecx\n"
1504
                  "rep movsb\n"
1505

    
1506
                  /* cmpsb: the single step should stop at each cmpsb iteration */
1507
                  "movl $sstep_buf1, %%esi\n"
1508
                  "movl $sstep_buf2, %%edi\n"
1509
                  "movl $0, %%ecx\n"
1510
                  "rep cmpsb\n"
1511
                  "movl $4, %%ecx\n"
1512
                  "rep cmpsb\n"
1513
                  
1514
                  /* getpid() syscall: single step should skip one
1515
                     instruction */
1516
                  "movl $20, %%eax\n"
1517
                  "int $0x80\n"
1518
                  "movl $0, %%eax\n"
1519
                  
1520
                  /* when modifying SS, trace is not done on the next
1521
                     instruction */
1522
                  "movl %%ss, %%ecx\n"
1523
                  "movl %%ecx, %%ss\n"
1524
                  "addl $1, %0\n"
1525
                  "movl $1, %%eax\n"
1526
                  "movl %%ecx, %%ss\n"
1527
                  "jmp 1f\n"
1528
                  "addl $1, %0\n"
1529
                  "1:\n"
1530
                  "movl $1, %%eax\n"
1531
                  "pushl %%ecx\n"
1532
                  "popl %%ss\n"
1533
                  "addl $1, %0\n"
1534
                  "movl $1, %%eax\n"
1535
                  
1536
                  "pushf\n"
1537
                  "andl $~0x00100, (%%esp)\n"
1538
                  "popf\n"
1539
                  : "=m" (val) 
1540
                  : 
1541
                  : "cc", "memory", "eax", "ecx", "esi", "edi");
1542
    printf("val=%d\n", val);
1543
    for(i = 0; i < 4; i++)
1544
        printf("sstep_buf2[%d] = %d\n", i, sstep_buf2[i]);
1545
}
1546

    
1547
/* self modifying code test */
1548
uint8_t code[] = {
1549
    0xb8, 0x1, 0x00, 0x00, 0x00, /* movl $1, %eax */
1550
    0xc3, /* ret */
1551
};
1552

    
1553
typedef int FuncType(void);
1554

    
1555
void test_self_modifying_code(void)
1556
{
1557
    int i;
1558

    
1559
    printf("self modifying code:\n");
1560
    printf("func1 = 0x%x\n", ((FuncType *)code)());
1561
    for(i = 2; i <= 4; i++) {
1562
        code[1] = i;
1563
        printf("func%d = 0x%x\n", i, ((FuncType *)code)());
1564
    }
1565
}
1566
    
1567
static void *call_end __init_call = NULL;
1568

    
1569
int main(int argc, char **argv)
1570
{
1571
    void **ptr;
1572
    void (*func)(void);
1573

    
1574
    ptr = &call_start + 1;
1575
    while (*ptr != NULL) {
1576
        func = *ptr++;
1577
        func();
1578
    }
1579
    test_bsx();
1580
    test_mul();
1581
    test_jcc();
1582
    test_floats();
1583
    test_bcd();
1584
    test_xchg();
1585
    test_string();
1586
    test_misc();
1587
    test_lea();
1588
    test_segs();
1589
    test_code16();
1590
    test_vm86();
1591
    test_exceptions();
1592
    test_self_modifying_code();
1593
    test_single_step();
1594
    return 0;
1595
}