1|
2|	x_unsupp.sa 3.3 7/1/91
3|
4|	fpsp_unsupp --- FPSP handler for unsupported data type exception
5|
6| Trap vector #55	(See table 8-1 Mc68030 User's manual).
7| Invoked when the user program encounters a data format (packed) that
8| hardware does not support or a data type (denormalized numbers or un-
9| normalized numbers).
10| Normalizes denorms and unnorms, unpacks packed numbers then stores
11| them back into the machine to let the 040 finish the operation.
12|
13| Unsupp calls two routines:
14| 	1. get_op -  gets the operand(s)
15| 	2. res_func - restore the function back into the 040 or
16| 			if fmove.p fpm,<ea> then pack source (fpm)
17| 			and store in users memory <ea>.
18|
19|  Input: Long fsave stack frame
20|
21|
22
23|		Copyright (C) Motorola, Inc. 1990
24|			All Rights Reserved
25|
26|	THIS IS UNPUBLISHED PROPRIETARY SOURCE CODE OF MOTOROLA
27|	The copyright notice above does not evidence any
28|	actual or intended publication of such source code.
29
30X_UNSUPP:	|idnt    2,1 | Motorola 040 Floating Point Software Package
31
32	|section	8
33
34	.include "fpsp.h"
35
36	|xref	get_op
37	|xref	res_func
38	|xref	gen_except
39	|xref	fpsp_fmt_error
40
41	.global	fpsp_unsupp
42fpsp_unsupp:
43|
44	link		%a6,#-LOCAL_SIZE
45	fsave		-(%a7)
46	moveml		%d0-%d1/%a0-%a1,USER_DA(%a6)
47	fmovemx	%fp0-%fp3,USER_FP0(%a6)
48	fmoveml	%fpcr/%fpsr/%fpiar,USER_FPCR(%a6)
49
50
51	moveb		(%a7),VER_TMP(%a6) |save version number
52	moveb		(%a7),%d0		|test for valid version num
53	andib		#0xf0,%d0		|test for $4x
54	cmpib		#VER_4,%d0	|must be $4x or exit
55	bnel		fpsp_fmt_error
56
57	fmovel		#0,%FPSR		|clear all user status bits
58	fmovel		#0,%FPCR		|clear all user control bits
59|
60|	The following lines are used to ensure that the FPSR
61|	exception byte and condition codes are clear before proceeding,
62|	except in the case of fmove, which leaves the cc's intact.
63|
64unsupp_con:
65	movel		USER_FPSR(%a6),%d1
66	btst		#5,CMDREG1B(%a6)	|looking for fmove out
67	bne		fmove_con
68	andl		#0xFF00FF,%d1	|clear all but aexcs and qbyte
69	bras		end_fix
70fmove_con:
71	andl		#0x0FFF40FF,%d1	|clear all but cc's, snan bit, aexcs, and qbyte
72end_fix:
73	movel		%d1,USER_FPSR(%a6)
74
75	st		UFLG_TMP(%a6)	|set flag for unsupp data
76
77	bsrl		get_op		|everything okay, go get operand(s)
78	bsrl		res_func	|fix up stack frame so can restore it
79	clrl		-(%a7)
80	moveb		VER_TMP(%a6),(%a7) |move idle fmt word to top of stack
81	bral		gen_except
82|
83	|end
84