diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /arch/m68k/math-emu/fp_movem.S |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'arch/m68k/math-emu/fp_movem.S')
-rw-r--r-- | arch/m68k/math-emu/fp_movem.S | 368 |
1 files changed, 368 insertions, 0 deletions
diff --git a/arch/m68k/math-emu/fp_movem.S b/arch/m68k/math-emu/fp_movem.S new file mode 100644 index 000000000000..8354d39e6c47 --- /dev/null +++ b/arch/m68k/math-emu/fp_movem.S | |||
@@ -0,0 +1,368 @@ | |||
1 | /* | ||
2 | * fp_movem.S | ||
3 | * | ||
4 | * Copyright Roman Zippel, 1997. All rights reserved. | ||
5 | * | ||
6 | * Redistribution and use in source and binary forms, with or without | ||
7 | * modification, are permitted provided that the following conditions | ||
8 | * are met: | ||
9 | * 1. Redistributions of source code must retain the above copyright | ||
10 | * notice, and the entire permission notice in its entirety, | ||
11 | * including the disclaimer of warranties. | ||
12 | * 2. Redistributions in binary form must reproduce the above copyright | ||
13 | * notice, this list of conditions and the following disclaimer in the | ||
14 | * documentation and/or other materials provided with the distribution. | ||
15 | * 3. The name of the author may not be used to endorse or promote | ||
16 | * products derived from this software without specific prior | ||
17 | * written permission. | ||
18 | * | ||
19 | * ALTERNATIVELY, this product may be distributed under the terms of | ||
20 | * the GNU General Public License, in which case the provisions of the GPL are | ||
21 | * required INSTEAD OF the above restrictions. (This clause is | ||
22 | * necessary due to a potential bad interaction between the GPL and | ||
23 | * the restrictions contained in a BSD-style copyright.) | ||
24 | * | ||
25 | * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED | ||
26 | * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES | ||
27 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE | ||
28 | * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, | ||
29 | * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES | ||
30 | * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR | ||
31 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) | ||
32 | * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, | ||
33 | * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | ||
34 | * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED | ||
35 | * OF THE POSSIBILITY OF SUCH DAMAGE. | ||
36 | */ | ||
37 | |||
38 | #include "fp_emu.h" | ||
39 | #include "fp_decode.h" | ||
40 | |||
41 | | set flags for decode macros for fmovem | ||
42 | do_fmovem=1 | ||
43 | |||
44 | .globl fp_fmovem_fp, fp_fmovem_cr | ||
45 | |||
46 | | %d1 contains the mask and count of the register list | ||
47 | | for other register usage see fp_decode.h | ||
48 | |||
49 | fp_fmovem_fp: | ||
50 | printf PDECODE,"fmovem.x " | ||
51 | | get register list and count them | ||
52 | btst #11,%d2 | ||
53 | jne 1f | ||
54 | bfextu %d2{#24,#8},%d0 | static register list | ||
55 | jra 2f | ||
56 | 1: bfextu %d2{#25,#3},%d0 | dynamic register list | ||
57 | jsr fp_get_data_reg | ||
58 | 2: move.l %d0,%d1 | ||
59 | swap %d1 | ||
60 | jra 2f | ||
61 | 1: addq.w #1,%d1 | count the # of registers in | ||
62 | 2: lsr.b #1,%d0 | register list and keep it in %d1 | ||
63 | jcs 1b | ||
64 | jne 2b | ||
65 | printf PDECODE,"#%08x",1,%d1 | ||
66 | #ifdef FPU_EMU_DEBUG | ||
67 | btst #12,%d2 | ||
68 | jne 1f | ||
69 | printf PDECODE,"-" | decremental move | ||
70 | jra 2f | ||
71 | 1: printf PDECODE,"+" | incremental move | ||
72 | 2: btst #13,%d2 | ||
73 | jeq 1f | ||
74 | printf PDECODE,"->" | fpu -> cpu | ||
75 | jra 2f | ||
76 | 1: printf PDECODE,"<-" | fpu <- cpu | ||
77 | 2: | ||
78 | #endif | ||
79 | |||
80 | | decode address mode | ||
81 | fp_decode_addr_mode | ||
82 | |||
83 | .long fp_ill, fp_ill | ||
84 | .long fpr_indirect, fpr_postinc | ||
85 | .long fpr_predecr, fpr_disp16 | ||
86 | .long fpr_extmode0, fpr_extmode1 | ||
87 | |||
88 | | addressing mode: address register indirect | ||
89 | fpr_indirect: | ||
90 | fp_mode_addr_indirect | ||
91 | jra fpr_do_movem | ||
92 | |||
93 | | addressing mode: address register indirect with postincrement | ||
94 | fpr_postinc: | ||
95 | fp_mode_addr_indirect_postinc | ||
96 | jra fpr_do_movem | ||
97 | |||
98 | fpr_predecr: | ||
99 | fp_mode_addr_indirect_predec | ||
100 | jra fpr_do_movem | ||
101 | |||
102 | | addressing mode: address register/programm counter indirect | ||
103 | | with 16bit displacement | ||
104 | fpr_disp16: | ||
105 | fp_mode_addr_indirect_disp16 | ||
106 | jra fpr_do_movem | ||
107 | |||
108 | fpr_extmode0: | ||
109 | fp_mode_addr_indirect_extmode0 | ||
110 | jra fpr_do_movem | ||
111 | |||
112 | fpr_extmode1: | ||
113 | fp_decode_addr_reg | ||
114 | jmp ([0f:w,%pc,%d0*4]) | ||
115 | |||
116 | .align 4 | ||
117 | 0: | ||
118 | .long fpr_absolute_short, fpr_absolute_long | ||
119 | .long fpr_disp16, fpr_extmode0 | ||
120 | .long fp_ill, fp_ill | ||
121 | .long fp_ill, fp_ill | ||
122 | |||
123 | fpr_absolute_short: | ||
124 | fp_mode_abs_short | ||
125 | jra fpr_do_movem | ||
126 | |||
127 | fpr_absolute_long: | ||
128 | fp_mode_abs_long | ||
129 | | jra fpr_do_movem | ||
130 | |||
131 | fpr_do_movem: | ||
132 | swap %d1 | get fpu register list | ||
133 | lea (FPD_FPREG,FPDATA),%a1 | ||
134 | moveq #12,%d0 | ||
135 | btst #12,%d2 | ||
136 | jne 1f | ||
137 | lea (-12,%a1,%d0*8),%a1 | ||
138 | neg.l %d0 | ||
139 | 1: btst #13,%d2 | ||
140 | jne 4f | ||
141 | | move register from memory into fpu | ||
142 | jra 3f | ||
143 | 1: printf PMOVEM,"(%p>%p)",2,%a0,%a1 | ||
144 | getuser.l (%a0)+,%d2,fp_err_ua1,%a0 | ||
145 | lsr.l #8,%d2 | ||
146 | lsr.l #7,%d2 | ||
147 | lsr.w #1,%d2 | ||
148 | move.l %d2,(%a1)+ | ||
149 | getuser.l (%a0)+,%d2,fp_err_ua1,%a0 | ||
150 | move.l %d2,(%a1)+ | ||
151 | getuser.l (%a0),%d2,fp_err_ua1,%a0 | ||
152 | move.l %d2,(%a1) | ||
153 | subq.l #8,%a0 | ||
154 | subq.l #8,%a1 | ||
155 | add.l %d0,%a0 | ||
156 | 2: add.l %d0,%a1 | ||
157 | 3: lsl.b #1,%d1 | ||
158 | jcs 1b | ||
159 | jne 2b | ||
160 | jra 5f | ||
161 | | move register from fpu into memory | ||
162 | 1: printf PMOVEM,"(%p>%p)",2,%a1,%a0 | ||
163 | move.l (%a1)+,%d2 | ||
164 | lsl.w #1,%d2 | ||
165 | lsl.l #7,%d2 | ||
166 | lsl.l #8,%d2 | ||
167 | putuser.l %d2,(%a0)+,fp_err_ua1,%a0 | ||
168 | move.l (%a1)+,%d2 | ||
169 | putuser.l %d2,(%a0)+,fp_err_ua1,%a0 | ||
170 | move.l (%a1),%d2 | ||
171 | putuser.l %d2,(%a0),fp_err_ua1,%a0 | ||
172 | subq.l #8,%a1 | ||
173 | subq.l #8,%a0 | ||
174 | add.l %d0,%a0 | ||
175 | 2: add.l %d0,%a1 | ||
176 | 4: lsl.b #1,%d1 | ||
177 | jcs 1b | ||
178 | jne 2b | ||
179 | 5: | ||
180 | printf PDECODE,"\n" | ||
181 | #if 0 | ||
182 | lea (FPD_FPREG,FPDATA),%a0 | ||
183 | printf PMOVEM,"fp:" | ||
184 | printx PMOVEM,%a0@(0) | ||
185 | printx PMOVEM,%a0@(12) | ||
186 | printf PMOVEM,"\n " | ||
187 | printx PMOVEM,%a0@(24) | ||
188 | printx PMOVEM,%a0@(36) | ||
189 | printf PMOVEM,"\n " | ||
190 | printx PMOVEM,%a0@(48) | ||
191 | printx PMOVEM,%a0@(60) | ||
192 | printf PMOVEM,"\n " | ||
193 | printx PMOVEM,%a0@(72) | ||
194 | printx PMOVEM,%a0@(84) | ||
195 | printf PMOVEM,"\n" | ||
196 | #endif | ||
197 | jra fp_end | ||
198 | |||
199 | | set flags for decode macros for fmovem control register | ||
200 | do_fmovem=1 | ||
201 | do_fmovem_cr=1 | ||
202 | |||
203 | fp_fmovem_cr: | ||
204 | printf PDECODE,"fmovem.cr " | ||
205 | | get register list and count them | ||
206 | bfextu %d2{#19,#3},%d0 | ||
207 | move.l %d0,%d1 | ||
208 | swap %d1 | ||
209 | jra 2f | ||
210 | 1: addq.w #1,%d1 | ||
211 | 2: lsr.l #1,%d0 | ||
212 | jcs 1b | ||
213 | jne 2b | ||
214 | printf PDECODE,"#%08x",1,%d1 | ||
215 | #ifdef FPU_EMU_DEBUG | ||
216 | btst #13,%d2 | ||
217 | jeq 1f | ||
218 | printf PDECODE,"->" | fpu -> cpu | ||
219 | jra 2f | ||
220 | 1: printf PDECODE,"<-" | fpu <- cpu | ||
221 | 2: | ||
222 | #endif | ||
223 | |||
224 | | decode address mode | ||
225 | fp_decode_addr_mode | ||
226 | |||
227 | .long fpc_data, fpc_addr | ||
228 | .long fpc_indirect, fpc_postinc | ||
229 | .long fpc_predecr, fpc_disp16 | ||
230 | .long fpc_extmode0, fpc_extmode1 | ||
231 | |||
232 | fpc_data: | ||
233 | fp_mode_data_direct | ||
234 | move.w %d0,%d1 | ||
235 | bfffo %d2{#19,#3},%d0 | ||
236 | sub.w #19,%d0 | ||
237 | lea (FPD_FPCR,FPDATA,%d0.w*4),%a1 | ||
238 | btst #13,%d2 | ||
239 | jne 1f | ||
240 | move.w %d1,%d0 | ||
241 | jsr fp_get_data_reg | ||
242 | move.l %d0,(%a1) | ||
243 | jra fpc_movem_fin | ||
244 | 1: move.l (%a1),%d0 | ||
245 | jsr fp_put_data_reg | ||
246 | jra fpc_movem_fin | ||
247 | |||
248 | fpc_addr: | ||
249 | fp_decode_addr_reg | ||
250 | printf PDECODE,"a%d",1,%d0 | ||
251 | btst #13,%d2 | ||
252 | jne 1f | ||
253 | jsr fp_get_addr_reg | ||
254 | move.l %a0,(FPD_FPIAR,FPDATA) | ||
255 | jra fpc_movem_fin | ||
256 | 1: move.l (FPD_FPIAR,FPDATA),%a0 | ||
257 | jsr fp_put_addr_reg | ||
258 | jra fpc_movem_fin | ||
259 | |||
260 | fpc_indirect: | ||
261 | fp_mode_addr_indirect | ||
262 | jra fpc_do_movem | ||
263 | |||
264 | fpc_postinc: | ||
265 | fp_mode_addr_indirect_postinc | ||
266 | jra fpc_do_movem | ||
267 | |||
268 | fpc_predecr: | ||
269 | fp_mode_addr_indirect_predec | ||
270 | jra fpc_do_movem | ||
271 | |||
272 | fpc_disp16: | ||
273 | fp_mode_addr_indirect_disp16 | ||
274 | jra fpc_do_movem | ||
275 | |||
276 | fpc_extmode0: | ||
277 | fp_mode_addr_indirect_extmode0 | ||
278 | jra fpc_do_movem | ||
279 | |||
280 | fpc_extmode1: | ||
281 | fp_decode_addr_reg | ||
282 | jmp ([0f:w,%pc,%d0*4]) | ||
283 | |||
284 | .align 4 | ||
285 | 0: | ||
286 | .long fpc_absolute_short, fpc_absolute_long | ||
287 | .long fpc_disp16, fpc_extmode0 | ||
288 | .long fpc_immediate, fp_ill | ||
289 | .long fp_ill, fp_ill | ||
290 | |||
291 | fpc_absolute_short: | ||
292 | fp_mode_abs_short | ||
293 | jra fpc_do_movem | ||
294 | |||
295 | fpc_absolute_long: | ||
296 | fp_mode_abs_long | ||
297 | jra fpc_do_movem | ||
298 | |||
299 | fpc_immediate: | ||
300 | fp_get_pc %a0 | ||
301 | lea (%a0,%d1.w*4),%a1 | ||
302 | fp_put_pc %a1 | ||
303 | printf PDECODE,"#imm" | ||
304 | | jra fpc_do_movem | ||
305 | #if 0 | ||
306 | swap %d1 | ||
307 | lsl.l #5,%d1 | ||
308 | lea (FPD_FPCR,FPDATA),%a0 | ||
309 | jra 3f | ||
310 | 1: move.l %d0,(%a0) | ||
311 | 2: addq.l #4,%a0 | ||
312 | 3: lsl.b #1,%d1 | ||
313 | jcs 1b | ||
314 | jne 2b | ||
315 | jra fpc_movem_fin | ||
316 | #endif | ||
317 | |||
318 | fpc_do_movem: | ||
319 | swap %d1 | get fpu register list | ||
320 | lsl.l #5,%d1 | ||
321 | lea (FPD_FPCR,FPDATA),%a1 | ||
322 | 1: btst #13,%d2 | ||
323 | jne 4f | ||
324 | |||
325 | | move register from memory into fpu | ||
326 | jra 3f | ||
327 | 1: printf PMOVEM,"(%p>%p)",2,%a0,%a1 | ||
328 | getuser.l (%a0)+,%d0,fp_err_ua1,%a0 | ||
329 | move.l %d0,(%a1) | ||
330 | 2: addq.l #4,%a1 | ||
331 | 3: lsl.b #1,%d1 | ||
332 | jcs 1b | ||
333 | jne 2b | ||
334 | jra fpc_movem_fin | ||
335 | |||
336 | | move register from fpu into memory | ||
337 | 1: printf PMOVEM,"(%p>%p)",2,%a1,%a0 | ||
338 | move.l (%a1),%d0 | ||
339 | putuser.l %d0,(%a0)+,fp_err_ua1,%a0 | ||
340 | 2: addq.l #4,%a1 | ||
341 | 4: lsl.b #1,%d1 | ||
342 | jcs 1b | ||
343 | jne 2b | ||
344 | |||
345 | fpc_movem_fin: | ||
346 | and.l #0x0000fff0,(FPD_FPCR,FPDATA) | ||
347 | and.l #0x0ffffff8,(FPD_FPSR,FPDATA) | ||
348 | move.l (FPD_FPCR,FPDATA),%d0 | ||
349 | lsr.l #4,%d0 | ||
350 | moveq #3,%d1 | ||
351 | and.l %d0,%d1 | ||
352 | move.w %d1,(FPD_RND,FPDATA) | ||
353 | lsr.l #2,%d0 | ||
354 | moveq #3,%d1 | ||
355 | and.l %d0,%d1 | ||
356 | move.w %d1,(FPD_PREC,FPDATA) | ||
357 | printf PDECODE,"\n" | ||
358 | #if 0 | ||
359 | printf PMOVEM,"fpcr : %08x\n",1,FPDATA@(FPD_FPCR) | ||
360 | printf PMOVEM,"fpsr : %08x\n",1,FPDATA@(FPD_FPSR) | ||
361 | printf PMOVEM,"fpiar: %08x\n",1,FPDATA@(FPD_FPIAR) | ||
362 | clr.l %d0 | ||
363 | move.w (FPD_PREC,FPDATA),%d0 | ||
364 | printf PMOVEM,"prec : %04x\n",1,%d0 | ||
365 | move.w (FPD_RND,FPDATA),%d0 | ||
366 | printf PMOVEM,"rnd : %04x\n",1,%d0 | ||
367 | #endif | ||
368 | jra fp_end | ||