Merge git://git.kernel.org/pub/scm/linux/kernel/git/steve/gfs2-2.6-nmw
[linux-2.6] / arch / x86 / math-emu / fpu_aux.c
1 /*---------------------------------------------------------------------------+
2  |  fpu_aux.c                                                                |
3  |                                                                           |
4  | Code to implement some of the FPU auxiliary instructions.                 |
5  |                                                                           |
6  | Copyright (C) 1992,1993,1994,1997                                         |
7  |                  W. Metzenthen, 22 Parker St, Ormond, Vic 3163, Australia |
8  |                  E-mail   billm@suburbia.net                              |
9  |                                                                           |
10  |                                                                           |
11  +---------------------------------------------------------------------------*/
12
13 #include "fpu_system.h"
14 #include "exception.h"
15 #include "fpu_emu.h"
16 #include "status_w.h"
17 #include "control_w.h"
18
19
20 static void fnop(void)
21 {
22 }
23
24 static void fclex(void)
25 {
26   partial_status &= ~(SW_Backward|SW_Summary|SW_Stack_Fault|SW_Precision|
27                    SW_Underflow|SW_Overflow|SW_Zero_Div|SW_Denorm_Op|
28                    SW_Invalid);
29   no_ip_update = 1;
30 }
31
32 /* Needs to be externally visible */
33 void finit(void)
34 {
35   control_word = 0x037f;
36   partial_status = 0;
37   top = 0;            /* We don't keep top in the status word internally. */
38   fpu_tag_word = 0xffff;
39   /* The behaviour is different from that detailed in
40      Section 15.1.6 of the Intel manual */
41   operand_address.offset = 0;
42   operand_address.selector = 0;
43   instruction_address.offset = 0;
44   instruction_address.selector = 0;
45   instruction_address.opcode = 0;
46   no_ip_update = 1;
47 }
48
49 /*
50  * These are nops on the i387..
51  */
52 #define feni fnop
53 #define fdisi fnop
54 #define fsetpm fnop
55
56 static FUNC const finit_table[] = {
57   feni, fdisi, fclex, finit,
58   fsetpm, FPU_illegal, FPU_illegal, FPU_illegal
59 };
60
61 void finit_(void)
62 {
63   (finit_table[FPU_rm])();
64 }
65
66
67 static void fstsw_ax(void)
68 {
69   *(short *) &FPU_EAX = status_word();
70   no_ip_update = 1;
71 }
72
73 static FUNC const fstsw_table[] = {
74   fstsw_ax, FPU_illegal, FPU_illegal, FPU_illegal,
75   FPU_illegal, FPU_illegal, FPU_illegal, FPU_illegal
76 };
77
78 void fstsw_(void)
79 {
80   (fstsw_table[FPU_rm])();
81 }
82
83
84 static FUNC const fp_nop_table[] = {
85   fnop, FPU_illegal, FPU_illegal, FPU_illegal,
86   FPU_illegal, FPU_illegal, FPU_illegal, FPU_illegal
87 };
88
89 void fp_nop(void)
90 {
91   (fp_nop_table[FPU_rm])();
92 }
93
94
95 void fld_i_(void)
96 {
97   FPU_REG *st_new_ptr;
98   int i;
99   u_char tag;
100
101   if ( STACK_OVERFLOW )
102     { FPU_stack_overflow(); return; }
103
104   /* fld st(i) */
105   i = FPU_rm;
106   if ( NOT_EMPTY(i) )
107     {
108       reg_copy(&st(i), st_new_ptr);
109       tag = FPU_gettagi(i);
110       push();
111       FPU_settag0(tag);
112     }
113   else
114     {
115       if ( control_word & CW_Invalid )
116         {
117           /* The masked response */
118           FPU_stack_underflow();
119         }
120       else
121         EXCEPTION(EX_StackUnder);
122     }
123
124 }
125
126
127 void fxch_i(void)
128 {
129   /* fxch st(i) */
130   FPU_REG t;
131   int i = FPU_rm;
132   FPU_REG *st0_ptr = &st(0), *sti_ptr = &st(i);
133   long tag_word = fpu_tag_word;
134   int regnr = top & 7, regnri = ((regnr + i) & 7);
135   u_char st0_tag = (tag_word >> (regnr*2)) & 3;
136   u_char sti_tag = (tag_word >> (regnri*2)) & 3;
137
138   if ( st0_tag == TAG_Empty )
139     {
140       if ( sti_tag == TAG_Empty )
141         {
142           FPU_stack_underflow();
143           FPU_stack_underflow_i(i);
144           return;
145         }
146       if ( control_word & CW_Invalid )
147         {
148           /* Masked response */
149           FPU_copy_to_reg0(sti_ptr, sti_tag);
150         }
151       FPU_stack_underflow_i(i);
152       return;
153     }
154   if ( sti_tag == TAG_Empty )
155     {
156       if ( control_word & CW_Invalid )
157         {
158           /* Masked response */
159           FPU_copy_to_regi(st0_ptr, st0_tag, i);
160         }
161       FPU_stack_underflow();
162       return;
163     }
164   clear_C1();
165
166   reg_copy(st0_ptr, &t);
167   reg_copy(sti_ptr, st0_ptr);
168   reg_copy(&t, sti_ptr);
169
170   tag_word &= ~(3 << (regnr*2)) & ~(3 << (regnri*2));
171   tag_word |= (sti_tag << (regnr*2)) | (st0_tag << (regnri*2));
172   fpu_tag_word = tag_word;
173 }
174
175
176 void ffree_(void)
177 {
178   /* ffree st(i) */
179   FPU_settagi(FPU_rm, TAG_Empty);
180 }
181
182
183 void ffreep(void)
184 {
185   /* ffree st(i) + pop - unofficial code */
186   FPU_settagi(FPU_rm, TAG_Empty);
187   FPU_pop();
188 }
189
190
191 void fst_i_(void)
192 {
193   /* fst st(i) */
194   FPU_copy_to_regi(&st(0), FPU_gettag0(), FPU_rm);
195 }
196
197
198 void fstp_i(void)
199 {
200   /* fstp st(i) */
201   FPU_copy_to_regi(&st(0), FPU_gettag0(), FPU_rm);
202   FPU_pop();
203 }
204