Acked-by: Alan Cox <alan@redhat.com> Signed-off-by: Matt Waddel <Matt.Waddel@freescale.com> Cc: Roman Zippel <zippel@linux-m68k.org> Signed-off-by: Andrew Morton <akpm@osdl.org> Signed-off-by: Linus Torvalds <torvalds@osdl.org>
		
			
				
	
	
		
			83 lines
		
	
	
		
			2.2 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			83 lines
		
	
	
		
			2.2 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
| |
 | |
| |	x_unsupp.sa 3.3 7/1/91
 | |
| |
 | |
| |	fpsp_unsupp --- FPSP handler for unsupported data type exception
 | |
| |
 | |
| | Trap vector #55	(See table 8-1 Mc68030 User's manual).
 | |
| | Invoked when the user program encounters a data format (packed) that
 | |
| | hardware does not support or a data type (denormalized numbers or un-
 | |
| | normalized numbers).
 | |
| | Normalizes denorms and unnorms, unpacks packed numbers then stores
 | |
| | them back into the machine to let the 040 finish the operation.
 | |
| |
 | |
| | Unsupp calls two routines:
 | |
| |	1. get_op -  gets the operand(s)
 | |
| |	2. res_func - restore the function back into the 040 or
 | |
| |			if fmove.p fpm,<ea> then pack source (fpm)
 | |
| |			and store in users memory <ea>.
 | |
| |
 | |
| |  Input: Long fsave stack frame
 | |
| |
 | |
| |
 | |
| 
 | |
| |		Copyright (C) Motorola, Inc. 1990
 | |
| |			All Rights Reserved
 | |
| |
 | |
| |       For details on the license for this file, please see the
 | |
| |       file, README, in this same directory.
 | |
| 
 | |
| X_UNSUPP:	|idnt    2,1 | Motorola 040 Floating Point Software Package
 | |
| 
 | |
| 	|section	8
 | |
| 
 | |
| #include "fpsp.h"
 | |
| 
 | |
| 	|xref	get_op
 | |
| 	|xref	res_func
 | |
| 	|xref	gen_except
 | |
| 	|xref	fpsp_fmt_error
 | |
| 
 | |
| 	.global	fpsp_unsupp
 | |
| fpsp_unsupp:
 | |
| |
 | |
| 	link		%a6,#-LOCAL_SIZE
 | |
| 	fsave		-(%a7)
 | |
| 	moveml		%d0-%d1/%a0-%a1,USER_DA(%a6)
 | |
| 	fmovemx	%fp0-%fp3,USER_FP0(%a6)
 | |
| 	fmoveml	%fpcr/%fpsr/%fpiar,USER_FPCR(%a6)
 | |
| 
 | |
| 
 | |
| 	moveb		(%a7),VER_TMP(%a6) |save version number
 | |
| 	moveb		(%a7),%d0		|test for valid version num
 | |
| 	andib		#0xf0,%d0		|test for $4x
 | |
| 	cmpib		#VER_4,%d0	|must be $4x or exit
 | |
| 	bnel		fpsp_fmt_error
 | |
| 
 | |
| 	fmovel		#0,%FPSR		|clear all user status bits
 | |
| 	fmovel		#0,%FPCR		|clear all user control bits
 | |
| |
 | |
| |	The following lines are used to ensure that the FPSR
 | |
| |	exception byte and condition codes are clear before proceeding,
 | |
| |	except in the case of fmove, which leaves the cc's intact.
 | |
| |
 | |
| unsupp_con:
 | |
| 	movel		USER_FPSR(%a6),%d1
 | |
| 	btst		#5,CMDREG1B(%a6)	|looking for fmove out
 | |
| 	bne		fmove_con
 | |
| 	andl		#0xFF00FF,%d1	|clear all but aexcs and qbyte
 | |
| 	bras		end_fix
 | |
| fmove_con:
 | |
| 	andl		#0x0FFF40FF,%d1	|clear all but cc's, snan bit, aexcs, and qbyte
 | |
| end_fix:
 | |
| 	movel		%d1,USER_FPSR(%a6)
 | |
| 
 | |
| 	st		UFLG_TMP(%a6)	|set flag for unsupp data
 | |
| 
 | |
| 	bsrl		get_op		|everything okay, go get operand(s)
 | |
| 	bsrl		res_func	|fix up stack frame so can restore it
 | |
| 	clrl		-(%a7)
 | |
| 	moveb		VER_TMP(%a6),(%a7) |move idle fmt word to top of stack
 | |
| 	bral		gen_except
 | |
| |
 | |
| 	|end
 |