CoCalc -- fp

GitHub Repository: awilliam/linux-vfio
Path: blob/master/arch/m68k/math-emu/fp_movem.S
¹⁰⁸¹⁷ views
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
369

370
Product

Resources

Company
