Merge branch 'autosuspend' into for-next
[linux-2.6] / arch / x86 / math-emu / load_store.c
1 /*---------------------------------------------------------------------------+
2  |  load_store.c                                                             |
3  |                                                                           |
4  | This file contains most of the code to interpret the FPU instructions     |
5  | which load and store from user memory.                                    |
6  |                                                                           |
7  | Copyright (C) 1992,1993,1994,1997                                         |
8  |                       W. Metzenthen, 22 Parker St, Ormond, Vic 3163,      |
9  |                       Australia.  E-mail   billm@suburbia.net             |
10  |                                                                           |
11  |                                                                           |
12  +---------------------------------------------------------------------------*/
13
14 /*---------------------------------------------------------------------------+
15  | Note:                                                                     |
16  |    The file contains code which accesses user memory.                     |
17  |    Emulator static data may change when user memory is accessed, due to   |
18  |    other processes using the emulator while swapping is in progress.      |
19  +---------------------------------------------------------------------------*/
20
21 #include <asm/uaccess.h>
22
23 #include "fpu_system.h"
24 #include "exception.h"
25 #include "fpu_emu.h"
26 #include "status_w.h"
27 #include "control_w.h"
28
29 #define _NONE_ 0                /* st0_ptr etc not needed */
30 #define _REG0_ 1                /* Will be storing st(0) */
31 #define _PUSH_ 3                /* Need to check for space to push onto stack */
32 #define _null_ 4                /* Function illegal or not implemented */
33
34 #define pop_0() { FPU_settag0(TAG_Empty); top++; }
35
36 static u_char const type_table[32] = {
37         _PUSH_, _PUSH_, _PUSH_, _PUSH_,
38         _null_, _null_, _null_, _null_,
39         _REG0_, _REG0_, _REG0_, _REG0_,
40         _REG0_, _REG0_, _REG0_, _REG0_,
41         _NONE_, _null_, _NONE_, _PUSH_,
42         _NONE_, _PUSH_, _null_, _PUSH_,
43         _NONE_, _null_, _NONE_, _REG0_,
44         _NONE_, _REG0_, _NONE_, _REG0_
45 };
46
47 u_char const data_sizes_16[32] = {
48         4, 4, 8, 2, 0, 0, 0, 0,
49         4, 4, 8, 2, 4, 4, 8, 2,
50         14, 0, 94, 10, 2, 10, 0, 8,
51         14, 0, 94, 10, 2, 10, 2, 8
52 };
53
54 static u_char const data_sizes_32[32] = {
55         4, 4, 8, 2, 0, 0, 0, 0,
56         4, 4, 8, 2, 4, 4, 8, 2,
57         28, 0, 108, 10, 2, 10, 0, 8,
58         28, 0, 108, 10, 2, 10, 2, 8
59 };
60
61 int FPU_load_store(u_char type, fpu_addr_modes addr_modes,
62                    void __user * data_address)
63 {
64         FPU_REG loaded_data;
65         FPU_REG *st0_ptr;
66         u_char st0_tag = TAG_Empty;     /* This is just to stop a gcc warning. */
67         u_char loaded_tag;
68
69         st0_ptr = NULL;         /* Initialized just to stop compiler warnings. */
70
71         if (addr_modes.default_mode & PROTECTED) {
72                 if (addr_modes.default_mode == SEG32) {
73                         if (access_limit < data_sizes_32[type])
74                                 math_abort(FPU_info, SIGSEGV);
75                 } else if (addr_modes.default_mode == PM16) {
76                         if (access_limit < data_sizes_16[type])
77                                 math_abort(FPU_info, SIGSEGV);
78                 }
79 #ifdef PARANOID
80                 else
81                         EXCEPTION(EX_INTERNAL | 0x140);
82 #endif /* PARANOID */
83         }
84
85         switch (type_table[type]) {
86         case _NONE_:
87                 break;
88         case _REG0_:
89                 st0_ptr = &st(0);       /* Some of these instructions pop after
90                                            storing */
91                 st0_tag = FPU_gettag0();
92                 break;
93         case _PUSH_:
94                 {
95                         if (FPU_gettagi(-1) != TAG_Empty) {
96                                 FPU_stack_overflow();
97                                 return 0;
98                         }
99                         top--;
100                         st0_ptr = &st(0);
101                 }
102                 break;
103         case _null_:
104                 FPU_illegal();
105                 return 0;
106 #ifdef PARANOID
107         default:
108                 EXCEPTION(EX_INTERNAL | 0x141);
109                 return 0;
110 #endif /* PARANOID */
111         }
112
113         switch (type) {
114         case 000:               /* fld m32real */
115                 clear_C1();
116                 loaded_tag =
117                     FPU_load_single((float __user *)data_address, &loaded_data);
118                 if ((loaded_tag == TAG_Special)
119                     && isNaN(&loaded_data)
120                     && (real_1op_NaN(&loaded_data) < 0)) {
121                         top++;
122                         break;
123                 }
124                 FPU_copy_to_reg0(&loaded_data, loaded_tag);
125                 break;
126         case 001:               /* fild m32int */
127                 clear_C1();
128                 loaded_tag =
129                     FPU_load_int32((long __user *)data_address, &loaded_data);
130                 FPU_copy_to_reg0(&loaded_data, loaded_tag);
131                 break;
132         case 002:               /* fld m64real */
133                 clear_C1();
134                 loaded_tag =
135                     FPU_load_double((double __user *)data_address,
136                                     &loaded_data);
137                 if ((loaded_tag == TAG_Special)
138                     && isNaN(&loaded_data)
139                     && (real_1op_NaN(&loaded_data) < 0)) {
140                         top++;
141                         break;
142                 }
143                 FPU_copy_to_reg0(&loaded_data, loaded_tag);
144                 break;
145         case 003:               /* fild m16int */
146                 clear_C1();
147                 loaded_tag =
148                     FPU_load_int16((short __user *)data_address, &loaded_data);
149                 FPU_copy_to_reg0(&loaded_data, loaded_tag);
150                 break;
151         case 010:               /* fst m32real */
152                 clear_C1();
153                 FPU_store_single(st0_ptr, st0_tag,
154                                  (float __user *)data_address);
155                 break;
156         case 011:               /* fist m32int */
157                 clear_C1();
158                 FPU_store_int32(st0_ptr, st0_tag, (long __user *)data_address);
159                 break;
160         case 012:               /* fst m64real */
161                 clear_C1();
162                 FPU_store_double(st0_ptr, st0_tag,
163                                  (double __user *)data_address);
164                 break;
165         case 013:               /* fist m16int */
166                 clear_C1();
167                 FPU_store_int16(st0_ptr, st0_tag, (short __user *)data_address);
168                 break;
169         case 014:               /* fstp m32real */
170                 clear_C1();
171                 if (FPU_store_single
172                     (st0_ptr, st0_tag, (float __user *)data_address))
173                         pop_0();        /* pop only if the number was actually stored
174                                            (see the 80486 manual p16-28) */
175                 break;
176         case 015:               /* fistp m32int */
177                 clear_C1();
178                 if (FPU_store_int32
179                     (st0_ptr, st0_tag, (long __user *)data_address))
180                         pop_0();        /* pop only if the number was actually stored
181                                            (see the 80486 manual p16-28) */
182                 break;
183         case 016:               /* fstp m64real */
184                 clear_C1();
185                 if (FPU_store_double
186                     (st0_ptr, st0_tag, (double __user *)data_address))
187                         pop_0();        /* pop only if the number was actually stored
188                                            (see the 80486 manual p16-28) */
189                 break;
190         case 017:               /* fistp m16int */
191                 clear_C1();
192                 if (FPU_store_int16
193                     (st0_ptr, st0_tag, (short __user *)data_address))
194                         pop_0();        /* pop only if the number was actually stored
195                                            (see the 80486 manual p16-28) */
196                 break;
197         case 020:               /* fldenv  m14/28byte */
198                 fldenv(addr_modes, (u_char __user *) data_address);
199                 /* Ensure that the values just loaded are not changed by
200                    fix-up operations. */
201                 return 1;
202         case 022:               /* frstor m94/108byte */
203                 frstor(addr_modes, (u_char __user *) data_address);
204                 /* Ensure that the values just loaded are not changed by
205                    fix-up operations. */
206                 return 1;
207         case 023:               /* fbld m80dec */
208                 clear_C1();
209                 loaded_tag = FPU_load_bcd((u_char __user *) data_address);
210                 FPU_settag0(loaded_tag);
211                 break;
212         case 024:               /* fldcw */
213                 RE_ENTRANT_CHECK_OFF;
214                 FPU_access_ok(VERIFY_READ, data_address, 2);
215                 FPU_get_user(control_word,
216                              (unsigned short __user *)data_address);
217                 RE_ENTRANT_CHECK_ON;
218                 if (partial_status & ~control_word & CW_Exceptions)
219                         partial_status |= (SW_Summary | SW_Backward);
220                 else
221                         partial_status &= ~(SW_Summary | SW_Backward);
222 #ifdef PECULIAR_486
223                 control_word |= 0x40;   /* An 80486 appears to always set this bit */
224 #endif /* PECULIAR_486 */
225                 return 1;
226         case 025:               /* fld m80real */
227                 clear_C1();
228                 loaded_tag =
229                     FPU_load_extended((long double __user *)data_address, 0);
230                 FPU_settag0(loaded_tag);
231                 break;
232         case 027:               /* fild m64int */
233                 clear_C1();
234                 loaded_tag = FPU_load_int64((long long __user *)data_address);
235                 if (loaded_tag == TAG_Error)
236                         return 0;
237                 FPU_settag0(loaded_tag);
238                 break;
239         case 030:               /* fstenv  m14/28byte */
240                 fstenv(addr_modes, (u_char __user *) data_address);
241                 return 1;
242         case 032:               /* fsave */
243                 fsave(addr_modes, (u_char __user *) data_address);
244                 return 1;
245         case 033:               /* fbstp m80dec */
246                 clear_C1();
247                 if (FPU_store_bcd
248                     (st0_ptr, st0_tag, (u_char __user *) data_address))
249                         pop_0();        /* pop only if the number was actually stored
250                                            (see the 80486 manual p16-28) */
251                 break;
252         case 034:               /* fstcw m16int */
253                 RE_ENTRANT_CHECK_OFF;
254                 FPU_access_ok(VERIFY_WRITE, data_address, 2);
255                 FPU_put_user(control_word,
256                              (unsigned short __user *)data_address);
257                 RE_ENTRANT_CHECK_ON;
258                 return 1;
259         case 035:               /* fstp m80real */
260                 clear_C1();
261                 if (FPU_store_extended
262                     (st0_ptr, st0_tag, (long double __user *)data_address))
263                         pop_0();        /* pop only if the number was actually stored
264                                            (see the 80486 manual p16-28) */
265                 break;
266         case 036:               /* fstsw m2byte */
267                 RE_ENTRANT_CHECK_OFF;
268                 FPU_access_ok(VERIFY_WRITE, data_address, 2);
269                 FPU_put_user(status_word(),
270                              (unsigned short __user *)data_address);
271                 RE_ENTRANT_CHECK_ON;
272                 return 1;
273         case 037:               /* fistp m64int */
274                 clear_C1();
275                 if (FPU_store_int64
276                     (st0_ptr, st0_tag, (long long __user *)data_address))
277                         pop_0();        /* pop only if the number was actually stored
278                                            (see the 80486 manual p16-28) */
279                 break;
280         }
281         return 0;
282 }