Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * fp_cond.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 | .globl fp_fscc, fp_fbccw, fp_fbccl | |
42 | ||
43 | #ifdef FPU_EMU_DEBUG | |
44 | fp_fnop: | |
45 | printf PDECODE,"fnop\n" | |
46 | jra fp_end | |
47 | #else | |
48 | #define fp_fnop fp_end | |
49 | #endif | |
50 | ||
51 | fp_fbccw: | |
52 | tst.w %d2 | |
53 | jeq fp_fnop | |
54 | printf PDECODE,"fbccw " | |
55 | fp_get_pc %a0 | |
56 | lea (-2,%a0,%d2.w),%a0 | |
57 | jra 1f | |
58 | ||
59 | fp_fbccl: | |
60 | printf PDECODE,"fbccl " | |
61 | fp_get_pc %a0 | |
62 | move.l %d2,%d0 | |
63 | swap %d0 | |
64 | fp_get_instr_word %d0,fp_err_ua1 | |
65 | lea (-2,%a0,%d0.l),%a0 | |
66 | 1: printf PDECODE,"%x",1,%a0 | |
67 | move.l %d2,%d0 | |
68 | swap %d0 | |
69 | jsr fp_compute_cond | |
70 | tst.l %d0 | |
71 | jeq 1f | |
72 | fp_put_pc %a0,1 | |
73 | 1: printf PDECODE,"\n" | |
74 | jra fp_end | |
75 | ||
76 | fp_fdbcc: | |
77 | printf PDECODE,"fdbcc " | |
78 | fp_get_pc %a1 | calculate new pc | |
79 | fp_get_instr_word %d0,fp_err_ua1 | |
80 | add.w %d0,%a1 | |
81 | fp_decode_addr_reg | |
82 | printf PDECODE,"d%d,%x\n",2,%d0,%a1 | |
83 | swap %d1 | test condition in %d1 | |
84 | tst.w %d1 | |
85 | jne 2f | |
86 | move.l %d0,%d1 | |
87 | jsr fp_get_data_reg | |
88 | subq.w #1,%d0 | |
89 | jcs 1f | |
90 | fp_put_pc %a1,1 | |
91 | 1: jsr fp_put_data_reg | |
92 | 2: jra fp_end | |
93 | ||
94 | | set flags for decode macros for fs<cc> | |
95 | do_fscc=1 | |
96 | do_no_pc_mode=1 | |
97 | ||
98 | fp_fscc: | |
99 | printf PDECODE,"fscc " | |
100 | move.l %d2,%d0 | |
101 | jsr fp_compute_cond | |
102 | move.w %d0,%d1 | |
103 | swap %d1 | |
104 | ||
105 | | decode addressing mode | |
106 | fp_decode_addr_mode | |
107 | ||
108 | .long fp_data, fp_fdbcc | |
109 | .long fp_indirect, fp_postinc | |
110 | .long fp_predecr, fp_disp16 | |
111 | .long fp_extmode0, fp_extmode1 | |
112 | ||
113 | | addressing mode: data register direct | |
114 | fp_data: | |
115 | fp_mode_data_direct | |
116 | move.w %d0,%d1 | save register nr | |
117 | jsr fp_get_data_reg | |
118 | swap %d1 | |
119 | move.b %d1,%d0 | |
120 | swap %d1 | |
121 | jsr fp_put_data_reg | |
122 | printf PDECODE,"\n" | |
123 | jra fp_end | |
124 | ||
125 | fp_indirect: | |
126 | fp_mode_addr_indirect | |
127 | jra fp_do_scc | |
128 | ||
129 | fp_postinc: | |
130 | fp_mode_addr_indirect_postinc | |
131 | jra fp_do_scc | |
132 | ||
133 | fp_predecr: | |
134 | fp_mode_addr_indirect_predec | |
135 | jra fp_do_scc | |
136 | ||
137 | fp_disp16: | |
138 | fp_mode_addr_indirect_disp16 | |
139 | jra fp_do_scc | |
140 | ||
141 | fp_extmode0: | |
142 | fp_mode_addr_indirect_extmode0 | |
143 | jra fp_do_scc | |
144 | ||
145 | fp_extmode1: | |
146 | bfextu %d2{#13,#3},%d0 | |
147 | jmp ([0f:w,%pc,%d0*4]) | |
148 | ||
149 | .align 4 | |
150 | 0: | |
151 | .long fp_absolute_short, fp_absolute_long | |
152 | .long fp_ill, fp_ill | NOTE: jump here to ftrap.x | |
153 | .long fp_ill, fp_ill | |
154 | .long fp_ill, fp_ill | |
155 | ||
156 | fp_absolute_short: | |
157 | fp_mode_abs_short | |
158 | jra fp_do_scc | |
159 | ||
160 | fp_absolute_long: | |
161 | fp_mode_abs_long | |
162 | | jra fp_do_scc | |
163 | ||
164 | fp_do_scc: | |
165 | swap %d1 | |
166 | putuser.b %d1,(%a0),fp_err_ua1,%a0 | |
167 | printf PDECODE,"\n" | |
168 | jra fp_end | |
169 | ||
170 | ||
171 | #define tst_NAN btst #24,%d1 | |
172 | #define tst_Z btst #26,%d1 | |
173 | #define tst_N btst #27,%d1 | |
174 | ||
175 | fp_compute_cond: | |
176 | move.l (FPD_FPSR,FPDATA),%d1 | |
177 | btst #4,%d0 | |
178 | jeq 1f | |
179 | tst_NAN | |
180 | jeq 1f | |
181 | bset #15,%d1 | |
182 | bset #7,%d1 | |
183 | move.l %d1,(FPD_FPSR,FPDATA) | |
184 | 1: and.w #0xf,%d0 | |
185 | jmp ([0f:w,%pc,%d0.w*4]) | |
186 | ||
187 | .align 4 | |
188 | 0: | |
189 | .long fp_f , fp_eq , fp_ogt, fp_oge | |
190 | .long fp_olt, fp_ole, fp_ogl, fp_or | |
191 | .long fp_un , fp_ueq, fp_ugt, fp_uge | |
192 | .long fp_ult, fp_ule, fp_ne , fp_t | |
193 | ||
194 | fp_f: | |
195 | moveq #0,%d0 | |
196 | rts | |
197 | ||
198 | fp_eq: | |
199 | moveq #0,%d0 | |
200 | tst_Z | |
201 | jeq 1f | |
202 | moveq #-1,%d0 | |
203 | 1: rts | |
204 | ||
205 | fp_ogt: | |
206 | moveq #0,%d0 | |
207 | tst_NAN | |
208 | jne 1f | |
209 | tst_Z | |
210 | jne 1f | |
211 | tst_N | |
212 | jne 1f | |
213 | moveq #-1,%d0 | |
214 | 1: rts | |
215 | ||
216 | fp_oge: | |
217 | moveq #-1,%d0 | |
218 | tst_Z | |
219 | jne 2f | |
220 | tst_NAN | |
221 | jne 1f | |
222 | tst_N | |
223 | jeq 2f | |
224 | 1: moveq #0,%d0 | |
225 | 2: rts | |
226 | ||
227 | fp_olt: | |
228 | moveq #0,%d0 | |
229 | tst_NAN | |
230 | jne 1f | |
231 | tst_Z | |
232 | jne 1f | |
233 | tst_N | |
234 | jeq 1f | |
235 | moveq #-1,%d0 | |
236 | 1: rts | |
237 | ||
238 | fp_ole: | |
239 | moveq #-1,%d0 | |
240 | tst_Z | |
241 | jne 2f | |
242 | tst_NAN | |
243 | jne 1f | |
244 | tst_N | |
245 | jne 2f | |
246 | 1: moveq #0,%d0 | |
247 | 2: rts | |
248 | ||
249 | fp_ogl: | |
250 | moveq #0,%d0 | |
251 | tst_NAN | |
252 | jne 1f | |
253 | tst_Z | |
254 | jne 1f | |
255 | moveq #-1,%d0 | |
256 | 1: rts | |
257 | ||
258 | fp_or: | |
259 | moveq #0,%d0 | |
260 | tst_NAN | |
261 | jne 1f | |
262 | moveq #-1,%d0 | |
263 | 1: rts | |
264 | ||
265 | fp_un: | |
266 | moveq #0,%d0 | |
267 | tst_NAN | |
268 | jeq 1f | |
269 | moveq #-1,%d0 | |
270 | rts | |
271 | ||
272 | fp_ueq: | |
273 | moveq #-1,%d0 | |
274 | tst_NAN | |
275 | jne 1f | |
276 | tst_Z | |
277 | jne 1f | |
278 | moveq #0,%d0 | |
279 | 1: rts | |
280 | ||
281 | fp_ugt: | |
282 | moveq #-1,%d0 | |
283 | tst_NAN | |
284 | jne 2f | |
285 | tst_N | |
286 | jne 1f | |
287 | tst_Z | |
288 | jeq 2f | |
289 | 1: moveq #0,%d0 | |
290 | 2: rts | |
291 | ||
292 | fp_uge: | |
293 | moveq #-1,%d0 | |
294 | tst_NAN | |
295 | jne 1f | |
296 | tst_Z | |
297 | jne 1f | |
298 | tst_N | |
299 | jeq 1f | |
300 | moveq #0,%d0 | |
301 | 1: rts | |
302 | ||
303 | fp_ult: | |
304 | moveq #-1,%d0 | |
305 | tst_NAN | |
306 | jne 2f | |
307 | tst_Z | |
308 | jne 1f | |
309 | tst_N | |
310 | jne 2f | |
311 | 1: moveq #0,%d0 | |
312 | 2: rts | |
313 | ||
314 | fp_ule: | |
315 | moveq #-1,%d0 | |
316 | tst_NAN | |
317 | jne 1f | |
318 | tst_Z | |
319 | jne 1f | |
320 | tst_N | |
321 | jne 1f | |
322 | moveq #0,%d0 | |
323 | 1: rts | |
324 | ||
325 | fp_ne: | |
326 | moveq #0,%d0 | |
327 | tst_Z | |
328 | jne 1f | |
329 | moveq #-1,%d0 | |
330 | 1: rts | |
331 | ||
332 | fp_t: | |
333 | moveq #-1,%d0 | |
334 | rts |