1|
2|	do_func.sa 3.4 2/18/91
3|
4| Do_func performs the unimplemented operation.  The operation
5| to be performed is determined from the lower 7 bits of the
6| extension word (except in the case of fmovecr and fsincos).
7| The opcode and tag bits form an index into a jump table in
8| tbldo.sa.  Cases of zero, infinity and NaN are handled in
9| do_func by forcing the default result.  Normalized and
10| denormalized (there are no unnormalized numbers at this
11| point) are passed onto the emulation code.
12|
13| CMDREG1B and STAG are extracted from the fsave frame
14| and combined to form the table index.  The function called
15| will start with a0 pointing to the ETEMP operand.  Dyadic
16| functions can find FPTEMP at -12(a0).
17|
18| Called functions return their result in fp0.  Sincos returns
19| sin(x) in fp0 and cos(x) in fp1.
20|
21
22|		Copyright (C) Motorola, Inc. 1990
23|			All Rights Reserved
24|
25|       For details on the license for this file, please see the
26|       file, README, in this same directory.
27
28DO_FUNC:	|idnt    2,1 | Motorola 040 Floating Point Software Package
29
30	|section	8
31
32#include "fpsp.h"
33
34	|xref	t_dz2
35	|xref	t_operr
36	|xref	t_inx2
37	|xref	t_resdnrm
38	|xref	dst_nan
39	|xref	src_nan
40	|xref	nrm_set
41	|xref	sto_cos
42
43	|xref	tblpre
44	|xref	slognp1,slogn,slog10,slog2
45	|xref	slognd,slog10d,slog2d
46	|xref	smod,srem
47	|xref	sscale
48	|xref	smovcr
49
50PONE:	.long	0x3fff0000,0x80000000,0x00000000	|+1
51MONE:	.long	0xbfff0000,0x80000000,0x00000000	|-1
52PZERO:	.long	0x00000000,0x00000000,0x00000000	|+0
53MZERO:	.long	0x80000000,0x00000000,0x00000000	|-0
54PINF:	.long	0x7fff0000,0x00000000,0x00000000	|+inf
55MINF:	.long	0xffff0000,0x00000000,0x00000000	|-inf
56QNAN:	.long	0x7fff0000,0xffffffff,0xffffffff	|non-signaling nan
57PPIBY2:  .long	0x3FFF0000,0xC90FDAA2,0x2168C235	|+PI/2
58MPIBY2:  .long	0xbFFF0000,0xC90FDAA2,0x2168C235	|-PI/2
59
60	.global	do_func
61do_func:
62	clrb	CU_ONLY(%a6)
63|
64| Check for fmovecr.  It does not follow the format of fp gen
65| unimplemented instructions.  The test is on the upper 6 bits;
66| if they are $17, the inst is fmovecr.  Call entry smovcr
67| directly.
68|
69	bfextu	CMDREG1B(%a6){#0:#6},%d0 |get opclass and src fields
70	cmpil	#0x17,%d0		|if op class and size fields are $17,
71|				;it is FMOVECR; if not, continue
72	bnes	not_fmovecr
73	jmp	smovcr		|fmovecr; jmp directly to emulation
74
75not_fmovecr:
76	movew	CMDREG1B(%a6),%d0
77	andl	#0x7F,%d0
78	cmpil	#0x38,%d0		|if the extension is >= $38,
79	bge	serror		|it is illegal
80	bfextu	STAG(%a6){#0:#3},%d1
81	lsll	#3,%d0		|make room for STAG
82	addl	%d1,%d0		|combine for final index into table
83	leal	tblpre,%a1	|start of monster jump table
84	movel	(%a1,%d0.w*4),%a1	|real target address
85	leal	ETEMP(%a6),%a0	|a0 is pointer to src op
86	movel	USER_FPCR(%a6),%d1
87	andl	#0xFF,%d1		| discard all but rounding mode/prec
88	fmovel	#0,%fpcr
89	jmp	(%a1)
90|
91|	ERROR
92|
93	.global	serror
94serror:
95	st	STORE_FLG(%a6)
96	rts
97|
98| These routines load forced values into fp0.  They are called
99| by index into tbldo.
100|
101| Load a signed zero to fp0 and set inex2/ainex
102|
103	.global	snzrinx
104snzrinx:
105	btstb	#sign_bit,LOCAL_EX(%a0)	|get sign of source operand
106	bnes	ld_mzinx	|if negative, branch
107	bsr	ld_pzero	|bsr so we can return and set inx
108	bra	t_inx2		|now, set the inx for the next inst
109ld_mzinx:
110	bsr	ld_mzero	|if neg, load neg zero, return here
111	bra	t_inx2		|now, set the inx for the next inst
112|
113| Load a signed zero to fp0; do not set inex2/ainex
114|
115	.global	szero
116szero:
117	btstb	#sign_bit,LOCAL_EX(%a0) |get sign of source operand
118	bne	ld_mzero	|if neg, load neg zero
119	bra	ld_pzero	|load positive zero
120|
121| Load a signed infinity to fp0; do not set inex2/ainex
122|
123	.global	sinf
124sinf:
125	btstb	#sign_bit,LOCAL_EX(%a0)	|get sign of source operand
126	bne	ld_minf			|if negative branch
127	bra	ld_pinf
128|
129| Load a signed one to fp0; do not set inex2/ainex
130|
131	.global	sone
132sone:
133	btstb	#sign_bit,LOCAL_EX(%a0)	|check sign of source
134	bne	ld_mone
135	bra	ld_pone
136|
137| Load a signed pi/2 to fp0; do not set inex2/ainex
138|
139	.global	spi_2
140spi_2:
141	btstb	#sign_bit,LOCAL_EX(%a0)	|check sign of source
142	bne	ld_mpi2
143	bra	ld_ppi2
144|
145| Load either a +0 or +inf for plus/minus operand
146|
147	.global	szr_inf
148szr_inf:
149	btstb	#sign_bit,LOCAL_EX(%a0)	|check sign of source
150	bne	ld_pzero
151	bra	ld_pinf
152|
153| Result is either an operr or +inf for plus/minus operand
154| [Used by slogn, slognp1, slog10, and slog2]
155|
156	.global	sopr_inf
157sopr_inf:
158	btstb	#sign_bit,LOCAL_EX(%a0)	|check sign of source
159	bne	t_operr
160	bra	ld_pinf
161|
162|	FLOGNP1
163|
164	.global	sslognp1
165sslognp1:
166	fmovemx (%a0),%fp0-%fp0
167	fcmpb	#-1,%fp0
168	fbgt	slognp1
169	fbeq	t_dz2		|if = -1, divide by zero exception
170	fmovel	#0,%FPSR		|clr N flag
171	bra	t_operr		|take care of operands < -1
172|
173|	FETOXM1
174|
175	.global	setoxm1i
176setoxm1i:
177	btstb	#sign_bit,LOCAL_EX(%a0)	|check sign of source
178	bne	ld_mone
179	bra	ld_pinf
180|
181|	FLOGN
182|
183| Test for 1.0 as an input argument, returning +zero.  Also check
184| the sign and return operr if negative.
185|
186	.global	sslogn
187sslogn:
188	btstb	#sign_bit,LOCAL_EX(%a0)
189	bne	t_operr		|take care of operands < 0
190	cmpiw	#0x3fff,LOCAL_EX(%a0) |test for 1.0 input
191	bne	slogn
192	cmpil	#0x80000000,LOCAL_HI(%a0)
193	bne	slogn
194	tstl	LOCAL_LO(%a0)
195	bne	slogn
196	fmovex	PZERO,%fp0
197	rts
198
199	.global	sslognd
200sslognd:
201	btstb	#sign_bit,LOCAL_EX(%a0)
202	beq	slognd
203	bra	t_operr		|take care of operands < 0
204
205|
206|	FLOG10
207|
208	.global	sslog10
209sslog10:
210	btstb	#sign_bit,LOCAL_EX(%a0)
211	bne	t_operr		|take care of operands < 0
212	cmpiw	#0x3fff,LOCAL_EX(%a0) |test for 1.0 input
213	bne	slog10
214	cmpil	#0x80000000,LOCAL_HI(%a0)
215	bne	slog10
216	tstl	LOCAL_LO(%a0)
217	bne	slog10
218	fmovex	PZERO,%fp0
219	rts
220
221	.global	sslog10d
222sslog10d:
223	btstb	#sign_bit,LOCAL_EX(%a0)
224	beq	slog10d
225	bra	t_operr		|take care of operands < 0
226
227|
228|	FLOG2
229|
230	.global	sslog2
231sslog2:
232	btstb	#sign_bit,LOCAL_EX(%a0)
233	bne	t_operr		|take care of operands < 0
234	cmpiw	#0x3fff,LOCAL_EX(%a0) |test for 1.0 input
235	bne	slog2
236	cmpil	#0x80000000,LOCAL_HI(%a0)
237	bne	slog2
238	tstl	LOCAL_LO(%a0)
239	bne	slog2
240	fmovex	PZERO,%fp0
241	rts
242
243	.global	sslog2d
244sslog2d:
245	btstb	#sign_bit,LOCAL_EX(%a0)
246	beq	slog2d
247	bra	t_operr		|take care of operands < 0
248
249|
250|	FMOD
251|
252pmodt:
253|				;$21 fmod
254|				;dtag,stag
255	.long	smod		|  00,00  norm,norm = normal
256	.long	smod_oper	|  00,01  norm,zero = nan with operr
257	.long	smod_fpn	|  00,10  norm,inf  = fpn
258	.long	smod_snan	|  00,11  norm,nan  = nan
259	.long	smod_zro	|  01,00  zero,norm = +-zero
260	.long	smod_oper	|  01,01  zero,zero = nan with operr
261	.long	smod_zro	|  01,10  zero,inf  = +-zero
262	.long	smod_snan	|  01,11  zero,nan  = nan
263	.long	smod_oper	|  10,00  inf,norm  = nan with operr
264	.long	smod_oper	|  10,01  inf,zero  = nan with operr
265	.long	smod_oper	|  10,10  inf,inf   = nan with operr
266	.long	smod_snan	|  10,11  inf,nan   = nan
267	.long	smod_dnan	|  11,00  nan,norm  = nan
268	.long	smod_dnan	|  11,01  nan,zero  = nan
269	.long	smod_dnan	|  11,10  nan,inf   = nan
270	.long	smod_dnan	|  11,11  nan,nan   = nan
271
272	.global	pmod
273pmod:
274	clrb	FPSR_QBYTE(%a6) | clear quotient field
275	bfextu	STAG(%a6){#0:#3},%d0 |stag = d0
276	bfextu	DTAG(%a6){#0:#3},%d1 |dtag = d1
277
278|
279| Alias extended denorms to norms for the jump table.
280|
281	bclrl	#2,%d0
282	bclrl	#2,%d1
283
284	lslb	#2,%d1
285	orb	%d0,%d1		|d1{3:2} = dtag, d1{1:0} = stag
286|				;Tag values:
287|				;00 = norm or denorm
288|				;01 = zero
289|				;10 = inf
290|				;11 = nan
291	lea	pmodt,%a1
292	movel	(%a1,%d1.w*4),%a1
293	jmp	(%a1)
294
295smod_snan:
296	bra	src_nan
297smod_dnan:
298	bra	dst_nan
299smod_oper:
300	bra	t_operr
301smod_zro:
302	moveb	ETEMP(%a6),%d1	|get sign of src op
303	moveb	FPTEMP(%a6),%d0	|get sign of dst op
304	eorb	%d0,%d1		|get exor of sign bits
305	btstl	#7,%d1		|test for sign
306	beqs	smod_zsn	|if clr, do not set sign big
307	bsetb	#q_sn_bit,FPSR_QBYTE(%a6) |set q-byte sign bit
308smod_zsn:
309	btstl	#7,%d0		|test if + or -
310	beq	ld_pzero	|if pos then load +0
311	bra	ld_mzero	|else neg load -0
312
313smod_fpn:
314	moveb	ETEMP(%a6),%d1	|get sign of src op
315	moveb	FPTEMP(%a6),%d0	|get sign of dst op
316	eorb	%d0,%d1		|get exor of sign bits
317	btstl	#7,%d1		|test for sign
318	beqs	smod_fsn	|if clr, do not set sign big
319	bsetb	#q_sn_bit,FPSR_QBYTE(%a6) |set q-byte sign bit
320smod_fsn:
321	tstb	DTAG(%a6)	|filter out denormal destination case
322	bpls	smod_nrm	|
323	leal	FPTEMP(%a6),%a0	|a0<- addr(FPTEMP)
324	bra	t_resdnrm	|force UNFL(but exact) result
325smod_nrm:
326	fmovel USER_FPCR(%a6),%fpcr |use user's rmode and precision
327	fmovex FPTEMP(%a6),%fp0	|return dest to fp0
328	rts
329
330|
331|	FREM
332|
333premt:
334|				;$25 frem
335|				;dtag,stag
336	.long	srem		|  00,00  norm,norm = normal
337	.long	srem_oper	|  00,01  norm,zero = nan with operr
338	.long	srem_fpn	|  00,10  norm,inf  = fpn
339	.long	srem_snan	|  00,11  norm,nan  = nan
340	.long	srem_zro	|  01,00  zero,norm = +-zero
341	.long	srem_oper	|  01,01  zero,zero = nan with operr
342	.long	srem_zro	|  01,10  zero,inf  = +-zero
343	.long	srem_snan	|  01,11  zero,nan  = nan
344	.long	srem_oper	|  10,00  inf,norm  = nan with operr
345	.long	srem_oper	|  10,01  inf,zero  = nan with operr
346	.long	srem_oper	|  10,10  inf,inf   = nan with operr
347	.long	srem_snan	|  10,11  inf,nan   = nan
348	.long	srem_dnan	|  11,00  nan,norm  = nan
349	.long	srem_dnan	|  11,01  nan,zero  = nan
350	.long	srem_dnan	|  11,10  nan,inf   = nan
351	.long	srem_dnan	|  11,11  nan,nan   = nan
352
353	.global	prem
354prem:
355	clrb	FPSR_QBYTE(%a6)   |clear quotient field
356	bfextu	STAG(%a6){#0:#3},%d0 |stag = d0
357	bfextu	DTAG(%a6){#0:#3},%d1 |dtag = d1
358|
359| Alias extended denorms to norms for the jump table.
360|
361	bclr	#2,%d0
362	bclr	#2,%d1
363
364	lslb	#2,%d1
365	orb	%d0,%d1		|d1{3:2} = dtag, d1{1:0} = stag
366|				;Tag values:
367|				;00 = norm or denorm
368|				;01 = zero
369|				;10 = inf
370|				;11 = nan
371	lea	premt,%a1
372	movel	(%a1,%d1.w*4),%a1
373	jmp	(%a1)
374
375srem_snan:
376	bra	src_nan
377srem_dnan:
378	bra	dst_nan
379srem_oper:
380	bra	t_operr
381srem_zro:
382	moveb	ETEMP(%a6),%d1	|get sign of src op
383	moveb	FPTEMP(%a6),%d0	|get sign of dst op
384	eorb	%d0,%d1		|get exor of sign bits
385	btstl	#7,%d1		|test for sign
386	beqs	srem_zsn	|if clr, do not set sign big
387	bsetb	#q_sn_bit,FPSR_QBYTE(%a6) |set q-byte sign bit
388srem_zsn:
389	btstl	#7,%d0		|test if + or -
390	beq	ld_pzero	|if pos then load +0
391	bra	ld_mzero	|else neg load -0
392
393srem_fpn:
394	moveb	ETEMP(%a6),%d1	|get sign of src op
395	moveb	FPTEMP(%a6),%d0	|get sign of dst op
396	eorb	%d0,%d1		|get exor of sign bits
397	btstl	#7,%d1		|test for sign
398	beqs	srem_fsn	|if clr, do not set sign big
399	bsetb	#q_sn_bit,FPSR_QBYTE(%a6) |set q-byte sign bit
400srem_fsn:
401	tstb	DTAG(%a6)	|filter out denormal destination case
402	bpls	srem_nrm	|
403	leal	FPTEMP(%a6),%a0	|a0<- addr(FPTEMP)
404	bra	t_resdnrm	|force UNFL(but exact) result
405srem_nrm:
406	fmovel USER_FPCR(%a6),%fpcr |use user's rmode and precision
407	fmovex FPTEMP(%a6),%fp0	|return dest to fp0
408	rts
409|
410|	FSCALE
411|
412pscalet:
413|				;$26 fscale
414|				;dtag,stag
415	.long	sscale		|  00,00  norm,norm = result
416	.long	sscale		|  00,01  norm,zero = fpn
417	.long	scl_opr		|  00,10  norm,inf  = nan with operr
418	.long	scl_snan	|  00,11  norm,nan  = nan
419	.long	scl_zro		|  01,00  zero,norm = +-zero
420	.long	scl_zro		|  01,01  zero,zero = +-zero
421	.long	scl_opr		|  01,10  zero,inf  = nan with operr
422	.long	scl_snan	|  01,11  zero,nan  = nan
423	.long	scl_inf		|  10,00  inf,norm  = +-inf
424	.long	scl_inf		|  10,01  inf,zero  = +-inf
425	.long	scl_opr		|  10,10  inf,inf   = nan with operr
426	.long	scl_snan	|  10,11  inf,nan   = nan
427	.long	scl_dnan	|  11,00  nan,norm  = nan
428	.long	scl_dnan	|  11,01  nan,zero  = nan
429	.long	scl_dnan	|  11,10  nan,inf   = nan
430	.long	scl_dnan	|  11,11  nan,nan   = nan
431
432	.global	pscale
433pscale:
434	bfextu	STAG(%a6){#0:#3},%d0 |stag in d0
435	bfextu	DTAG(%a6){#0:#3},%d1 |dtag in d1
436	bclrl	#2,%d0		|alias  denorm into norm
437	bclrl	#2,%d1		|alias  denorm into norm
438	lslb	#2,%d1
439	orb	%d0,%d1		|d1{4:2} = dtag, d1{1:0} = stag
440|				;dtag values     stag values:
441|				;000 = norm      00 = norm
442|				;001 = zero	 01 = zero
443|				;010 = inf	 10 = inf
444|				;011 = nan	 11 = nan
445|				;100 = dnrm
446|
447|
448	leal	pscalet,%a1	|load start of jump table
449	movel	(%a1,%d1.w*4),%a1	|load a1 with label depending on tag
450	jmp	(%a1)		|go to the routine
451
452scl_opr:
453	bra	t_operr
454
455scl_dnan:
456	bra	dst_nan
457
458scl_zro:
459	btstb	#sign_bit,FPTEMP_EX(%a6)	|test if + or -
460	beq	ld_pzero		|if pos then load +0
461	bra	ld_mzero		|if neg then load -0
462scl_inf:
463	btstb	#sign_bit,FPTEMP_EX(%a6)	|test if + or -
464	beq	ld_pinf			|if pos then load +inf
465	bra	ld_minf			|else neg load -inf
466scl_snan:
467	bra	src_nan
468|
469|	FSINCOS
470|
471	.global	ssincosz
472ssincosz:
473	btstb	#sign_bit,ETEMP(%a6)	|get sign
474	beqs	sincosp
475	fmovex	MZERO,%fp0
476	bras	sincoscom
477sincosp:
478	fmovex PZERO,%fp0
479sincoscom:
480	fmovemx PONE,%fp1-%fp1	|do not allow FPSR to be affected
481	bra	sto_cos		|store cosine result
482
483	.global	ssincosi
484ssincosi:
485	fmovex QNAN,%fp1	|load NAN
486	bsr	sto_cos		|store cosine result
487	fmovex QNAN,%fp0	|load NAN
488	bra	t_operr
489
490	.global	ssincosnan
491ssincosnan:
492	movel	ETEMP_EX(%a6),FP_SCR1(%a6)
493	movel	ETEMP_HI(%a6),FP_SCR1+4(%a6)
494	movel	ETEMP_LO(%a6),FP_SCR1+8(%a6)
495	bsetb	#signan_bit,FP_SCR1+4(%a6)
496	fmovemx FP_SCR1(%a6),%fp1-%fp1
497	bsr	sto_cos
498	bra	src_nan
499|
500| This code forces default values for the zero, inf, and nan cases
501| in the transcendentals code.  The CC bits must be set in the
502| stacked FPSR to be correctly reported.
503|
504|**Returns +PI/2
505	.global	ld_ppi2
506ld_ppi2:
507	fmovex PPIBY2,%fp0		|load +pi/2
508	bra	t_inx2			|set inex2 exc
509
510|**Returns -PI/2
511	.global	ld_mpi2
512ld_mpi2:
513	fmovex MPIBY2,%fp0		|load -pi/2
514	orl	#neg_mask,USER_FPSR(%a6)	|set N bit
515	bra	t_inx2			|set inex2 exc
516
517|**Returns +inf
518	.global	ld_pinf
519ld_pinf:
520	fmovex PINF,%fp0		|load +inf
521	orl	#inf_mask,USER_FPSR(%a6)	|set I bit
522	rts
523
524|**Returns -inf
525	.global	ld_minf
526ld_minf:
527	fmovex MINF,%fp0		|load -inf
528	orl	#neg_mask+inf_mask,USER_FPSR(%a6)	|set N and I bits
529	rts
530
531|**Returns +1
532	.global	ld_pone
533ld_pone:
534	fmovex PONE,%fp0		|load +1
535	rts
536
537|**Returns -1
538	.global	ld_mone
539ld_mone:
540	fmovex MONE,%fp0		|load -1
541	orl	#neg_mask,USER_FPSR(%a6)	|set N bit
542	rts
543
544|**Returns +0
545	.global	ld_pzero
546ld_pzero:
547	fmovex PZERO,%fp0		|load +0
548	orl	#z_mask,USER_FPSR(%a6)	|set Z bit
549	rts
550
551|**Returns -0
552	.global	ld_mzero
553ld_mzero:
554	fmovex MZERO,%fp0		|load -0
555	orl	#neg_mask+z_mask,USER_FPSR(%a6)	|set N and Z bits
556	rts
557
558	|end
559