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