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
42do_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
49fp_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
561:	bfextu	%d2{#25,#3},%d0		| dynamic register list
57	jsr	fp_get_data_reg
582:	move.l	%d0,%d1
59	swap	%d1
60	jra	2f
611:	addq.w	#1,%d1			| count the # of registers in
622:	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
711:	printf	PDECODE,"+"		| incremental move
722:	btst	#13,%d2
73	jeq	1f
74	printf	PDECODE,"->"		| fpu -> cpu
75	jra	2f
761:	printf	PDECODE,"<-"		| fpu <- cpu
772:
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
89fpr_indirect:
90	fp_mode_addr_indirect
91	jra	fpr_do_movem
92
93	| addressing mode: address register indirect with postincrement
94fpr_postinc:
95	fp_mode_addr_indirect_postinc
96	jra	fpr_do_movem
97
98fpr_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
104fpr_disp16:
105	fp_mode_addr_indirect_disp16
106	jra	fpr_do_movem
107
108fpr_extmode0:
109	fp_mode_addr_indirect_extmode0
110	jra	fpr_do_movem
111
112fpr_extmode1:
113	fp_decode_addr_reg
114	jmp	([0f:w,%pc,%d0*4])
115
116	.align	4
1170:
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
123fpr_absolute_short:
124	fp_mode_abs_short
125	jra	fpr_do_movem
126
127fpr_absolute_long:
128	fp_mode_abs_long
129|	jra	fpr_do_movem
130
131fpr_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
1391:	btst	#13,%d2
140	jne	4f
141	| move register from memory into fpu
142	jra	3f
1431:	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
1562:	add.l	%d0,%a1
1573:	lsl.b	#1,%d1
158	jcs	1b
159	jne	2b
160	jra	5f
161	| move register from fpu into memory
1621:	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
1752:	add.l	%d0,%a1
1764:	lsl.b	#1,%d1
177	jcs	1b
178	jne	2b
1795:
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
200do_fmovem=1
201do_fmovem_cr=1
202
203fp_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
2101:	addq.w	#1,%d1
2112:	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
2201:	printf	PDECODE,"<-"		| fpu <- cpu
2212:
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
232fpc_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
2441:	move.l	(%a1),%d0
245	jsr	fp_put_data_reg
246	jra	fpc_movem_fin
247
248fpc_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
2561:	move.l	(FPD_FPIAR,FPDATA),%a0
257	jsr	fp_put_addr_reg
258	jra	fpc_movem_fin
259
260fpc_indirect:
261	fp_mode_addr_indirect
262	jra	fpc_do_movem
263
264fpc_postinc:
265	fp_mode_addr_indirect_postinc
266	jra	fpc_do_movem
267
268fpc_predecr:
269	fp_mode_addr_indirect_predec
270	jra	fpc_do_movem
271
272fpc_disp16:
273	fp_mode_addr_indirect_disp16
274	jra	fpc_do_movem
275
276fpc_extmode0:
277	fp_mode_addr_indirect_extmode0
278	jra	fpc_do_movem
279
280fpc_extmode1:
281	fp_decode_addr_reg
282	jmp	([0f:w,%pc,%d0*4])
283
284	.align	4
2850:
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
291fpc_absolute_short:
292	fp_mode_abs_short
293	jra	fpc_do_movem
294
295fpc_absolute_long:
296	fp_mode_abs_long
297	jra	fpc_do_movem
298
299fpc_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
3101:	move.l	%d0,(%a0)
3112:	addq.l	#4,%a0
3123:	lsl.b	#1,%d1
313	jcs	1b
314	jne	2b
315	jra	fpc_movem_fin
316#endif
317
318fpc_do_movem:
319	swap	%d1			| get fpu register list
320	lsl.l	#5,%d1
321	lea	(FPD_FPCR,FPDATA),%a1
3221:	btst	#13,%d2
323	jne	4f
324
325	| move register from memory into fpu
326	jra	3f
3271:	printf	PMOVEM,"(%p>%p)",2,%a0,%a1
328	getuser.l (%a0)+,%d0,fp_err_ua1,%a0
329	move.l	%d0,(%a1)
3302:	addq.l	#4,%a1
3313:	lsl.b	#1,%d1
332	jcs	1b
333	jne	2b
334	jra	fpc_movem_fin
335
336	| move register from fpu into memory
3371:	printf	PMOVEM,"(%p>%p)",2,%a1,%a0
338	move.l	(%a1),%d0
339	putuser.l %d0,(%a0)+,fp_err_ua1,%a0
3402:	addq.l	#4,%a1
3414:	lsl.b	#1,%d1
342	jcs	1b
343	jne	2b
344
345fpc_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
369