77 lines
		
	
	
		
			2.0 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			77 lines
		
	
	
		
			2.0 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
|
 | 
						|
|	x_unimp.sa 3.3 7/1/91
 | 
						|
|
 | 
						|
|	fpsp_unimp --- FPSP handler for unimplemented instruction
 | 
						|
|	exception.
 | 
						|
|
 | 
						|
| Invoked when the user program encounters a floating-point
 | 
						|
| op-code that hardware does not support.  Trap vector# 11
 | 
						|
| (See table 8-1 MC68030 User's Manual).
 | 
						|
|
 | 
						|
|
 | 
						|
| Note: An fsave for an unimplemented inst. will create a short
 | 
						|
| fsave stack.
 | 
						|
|
 | 
						|
|  Input: 1. Six word stack frame for unimplemented inst, four word
 | 
						|
|            for illegal
 | 
						|
|            (See table 8-7 MC68030 User's Manual).
 | 
						|
|         2. Unimp (short) fsave state frame created here by fsave
 | 
						|
|            instruction.
 | 
						|
|
 | 
						|
|
 | 
						|
|		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_UNIMP:	|idnt    2,1 | Motorola 040 Floating Point Software Package
 | 
						|
 | 
						|
	|section	8
 | 
						|
 | 
						|
#include "fpsp.h"
 | 
						|
 | 
						|
	|xref	get_op
 | 
						|
	|xref	do_func
 | 
						|
	|xref	sto_res
 | 
						|
	|xref	gen_except
 | 
						|
	|xref	fpsp_fmt_error
 | 
						|
 | 
						|
	.global	fpsp_unimp
 | 
						|
	.global	uni_2
 | 
						|
fpsp_unimp:
 | 
						|
	link		%a6,#-LOCAL_SIZE
 | 
						|
	fsave		-(%a7)
 | 
						|
uni_2:
 | 
						|
	moveml		%d0-%d1/%a0-%a1,USER_DA(%a6)
 | 
						|
	fmovemx	%fp0-%fp3,USER_FP0(%a6)
 | 
						|
	fmoveml	%fpcr/%fpsr/%fpiar,USER_FPCR(%a6)
 | 
						|
	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
 | 
						|
|
 | 
						|
|	Temporary D25B Fix
 | 
						|
|	The following lines are used to ensure that the FPSR
 | 
						|
|	exception byte and condition codes are clear before proceeding
 | 
						|
|
 | 
						|
	movel		USER_FPSR(%a6),%d0
 | 
						|
	andl		#0xFF00FF,%d0	|clear all but accrued exceptions
 | 
						|
	movel		%d0,USER_FPSR(%a6)
 | 
						|
	fmovel		#0,%FPSR |clear all user bits
 | 
						|
	fmovel		#0,%FPCR	|clear all user exceptions for FPSP
 | 
						|
 | 
						|
	clrb		UFLG_TMP(%a6)	|clr flag for unsupp data
 | 
						|
 | 
						|
	bsrl		get_op		|go get operand(s)
 | 
						|
	clrb		STORE_FLG(%a6)
 | 
						|
	bsrl		do_func		|do the function
 | 
						|
	fsave		-(%a7)		|capture possible exc state
 | 
						|
	tstb		STORE_FLG(%a6)
 | 
						|
	bnes		no_store	|if STORE_FLG is set, no store
 | 
						|
	bsrl		sto_res		|store the result in user space
 | 
						|
no_store:
 | 
						|
	bral		gen_except	|post any exceptions and return
 | 
						|
 | 
						|
	|end
 |