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>
		
			
				
	
	
		
			355 lines
		
	
	
	
		
			9.6 KiB
			
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			355 lines
		
	
	
	
		
			9.6 KiB
			
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
|
 | 
						|
|	x_operr.sa 3.5 7/1/91
 | 
						|
|
 | 
						|
|	fpsp_operr --- FPSP handler for operand error exception
 | 
						|
|
 | 
						|
|	See 68040 User's Manual pp. 9-44f
 | 
						|
|
 | 
						|
| Note 1: For trap disabled 040 does the following:
 | 
						|
| If the dest is a fp reg, then an extended precision non_signaling
 | 
						|
| NAN is stored in the dest reg.  If the dest format is b, w, or l and
 | 
						|
| the source op is a NAN, then garbage is stored as the result (actually
 | 
						|
| the upper 32 bits of the mantissa are sent to the integer unit). If
 | 
						|
| the dest format is integer (b, w, l) and the operr is caused by
 | 
						|
| integer overflow, or the source op is inf, then the result stored is
 | 
						|
| garbage.
 | 
						|
| There are three cases in which operr is incorrectly signaled on the
 | 
						|
| 040.  This occurs for move_out of format b, w, or l for the largest
 | 
						|
| negative integer (-2^7 for b, -2^15 for w, -2^31 for l).
 | 
						|
|
 | 
						|
|	  On opclass = 011 fmove.(b,w,l) that causes a conversion
 | 
						|
|	  overflow -> OPERR, the exponent in wbte (and fpte) is:
 | 
						|
|		byte    56 - (62 - exp)
 | 
						|
|		word    48 - (62 - exp)
 | 
						|
|		long    32 - (62 - exp)
 | 
						|
|
 | 
						|
|			where exp = (true exp) - 1
 | 
						|
|
 | 
						|
|  So, wbtemp and fptemp will contain the following on erroneously
 | 
						|
|	  signalled operr:
 | 
						|
|			fpts = 1
 | 
						|
|			fpte = $4000  (15 bit externally)
 | 
						|
|		byte	fptm = $ffffffff ffffff80
 | 
						|
|		word	fptm = $ffffffff ffff8000
 | 
						|
|		long	fptm = $ffffffff 80000000
 | 
						|
|
 | 
						|
| Note 2: For trap enabled 040 does the following:
 | 
						|
| If the inst is move_out, then same as Note 1.
 | 
						|
| If the inst is not move_out, the dest is not modified.
 | 
						|
| The exceptional operand is not defined for integer overflow
 | 
						|
| during a move_out.
 | 
						|
|
 | 
						|
 | 
						|
|		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_OPERR:	|idnt    2,1 | Motorola 040 Floating Point Software Package
 | 
						|
 | 
						|
	|section	8
 | 
						|
 | 
						|
#include "fpsp.h"
 | 
						|
 | 
						|
	|xref	mem_write
 | 
						|
	|xref	real_operr
 | 
						|
	|xref	real_inex
 | 
						|
	|xref	get_fline
 | 
						|
	|xref	fpsp_done
 | 
						|
	|xref	reg_dest
 | 
						|
 | 
						|
	.global	fpsp_operr
 | 
						|
fpsp_operr:
 | 
						|
|
 | 
						|
	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)
 | 
						|
 | 
						|
|
 | 
						|
| Check if this is an opclass 3 instruction.
 | 
						|
|  If so, fall through, else branch to operr_end
 | 
						|
|
 | 
						|
	btstb	#TFLAG,T_BYTE(%a6)
 | 
						|
	beqs	operr_end
 | 
						|
 | 
						|
|
 | 
						|
| If the destination size is B,W,or L, the operr must be
 | 
						|
| handled here.
 | 
						|
|
 | 
						|
	movel	CMDREG1B(%a6),%d0
 | 
						|
	bfextu	%d0{#3:#3},%d0	|0=long, 4=word, 6=byte
 | 
						|
	cmpib	#0,%d0		|determine size; check long
 | 
						|
	beq	operr_long
 | 
						|
	cmpib	#4,%d0		|check word
 | 
						|
	beq	operr_word
 | 
						|
	cmpib	#6,%d0		|check byte
 | 
						|
	beq	operr_byte
 | 
						|
 | 
						|
|
 | 
						|
| The size is not B,W,or L, so the operr is handled by the
 | 
						|
| kernel handler.  Set the operr bits and clean up, leaving
 | 
						|
| only the integer exception frame on the stack, and the
 | 
						|
| fpu in the original exceptional state.
 | 
						|
|
 | 
						|
operr_end:
 | 
						|
	bsetb		#operr_bit,FPSR_EXCEPT(%a6)
 | 
						|
	bsetb		#aiop_bit,FPSR_AEXCEPT(%a6)
 | 
						|
 | 
						|
	moveml		USER_DA(%a6),%d0-%d1/%a0-%a1
 | 
						|
	fmovemx	USER_FP0(%a6),%fp0-%fp3
 | 
						|
	fmoveml	USER_FPCR(%a6),%fpcr/%fpsr/%fpiar
 | 
						|
	frestore	(%a7)+
 | 
						|
	unlk		%a6
 | 
						|
	bral		real_operr
 | 
						|
 | 
						|
operr_long:
 | 
						|
	moveql	#4,%d1		|write size to d1
 | 
						|
	moveb	STAG(%a6),%d0	|test stag for nan
 | 
						|
	andib	#0xe0,%d0		|clr all but tag
 | 
						|
	cmpib	#0x60,%d0		|check for nan
 | 
						|
	beq	operr_nan
 | 
						|
	cmpil	#0x80000000,FPTEMP_LO(%a6) |test if ls lword is special
 | 
						|
	bnes	chklerr		|if not equal, check for incorrect operr
 | 
						|
	bsr	check_upper	|check if exp and ms mant are special
 | 
						|
	tstl	%d0
 | 
						|
	bnes	chklerr		|if d0 is true, check for incorrect operr
 | 
						|
	movel	#0x80000000,%d0	|store special case result
 | 
						|
	bsr	operr_store
 | 
						|
	bra	not_enabled	|clean and exit
 | 
						|
|
 | 
						|
|	CHECK FOR INCORRECTLY GENERATED OPERR EXCEPTION HERE
 | 
						|
|
 | 
						|
chklerr:
 | 
						|
	movew	FPTEMP_EX(%a6),%d0
 | 
						|
	andw	#0x7FFF,%d0	|ignore sign bit
 | 
						|
	cmpw	#0x3FFE,%d0	|this is the only possible exponent value
 | 
						|
	bnes	chklerr2
 | 
						|
fixlong:
 | 
						|
	movel	FPTEMP_LO(%a6),%d0
 | 
						|
	bsr	operr_store
 | 
						|
	bra	not_enabled
 | 
						|
chklerr2:
 | 
						|
	movew	FPTEMP_EX(%a6),%d0
 | 
						|
	andw	#0x7FFF,%d0	|ignore sign bit
 | 
						|
	cmpw	#0x4000,%d0
 | 
						|
	bcc	store_max	|exponent out of range
 | 
						|
 | 
						|
	movel	FPTEMP_LO(%a6),%d0
 | 
						|
	andl	#0x7FFF0000,%d0	|look for all 1's on bits 30-16
 | 
						|
	cmpl	#0x7FFF0000,%d0
 | 
						|
	beqs	fixlong
 | 
						|
 | 
						|
	tstl	FPTEMP_LO(%a6)
 | 
						|
	bpls	chklepos
 | 
						|
	cmpl	#0xFFFFFFFF,FPTEMP_HI(%a6)
 | 
						|
	beqs	fixlong
 | 
						|
	bra	store_max
 | 
						|
chklepos:
 | 
						|
	tstl	FPTEMP_HI(%a6)
 | 
						|
	beqs	fixlong
 | 
						|
	bra	store_max
 | 
						|
 | 
						|
operr_word:
 | 
						|
	moveql	#2,%d1		|write size to d1
 | 
						|
	moveb	STAG(%a6),%d0	|test stag for nan
 | 
						|
	andib	#0xe0,%d0		|clr all but tag
 | 
						|
	cmpib	#0x60,%d0		|check for nan
 | 
						|
	beq	operr_nan
 | 
						|
	cmpil	#0xffff8000,FPTEMP_LO(%a6) |test if ls lword is special
 | 
						|
	bnes	chkwerr		|if not equal, check for incorrect operr
 | 
						|
	bsr	check_upper	|check if exp and ms mant are special
 | 
						|
	tstl	%d0
 | 
						|
	bnes	chkwerr		|if d0 is true, check for incorrect operr
 | 
						|
	movel	#0x80000000,%d0	|store special case result
 | 
						|
	bsr	operr_store
 | 
						|
	bra	not_enabled	|clean and exit
 | 
						|
|
 | 
						|
|	CHECK FOR INCORRECTLY GENERATED OPERR EXCEPTION HERE
 | 
						|
|
 | 
						|
chkwerr:
 | 
						|
	movew	FPTEMP_EX(%a6),%d0
 | 
						|
	andw	#0x7FFF,%d0	|ignore sign bit
 | 
						|
	cmpw	#0x3FFE,%d0	|this is the only possible exponent value
 | 
						|
	bnes	store_max
 | 
						|
	movel	FPTEMP_LO(%a6),%d0
 | 
						|
	swap	%d0
 | 
						|
	bsr	operr_store
 | 
						|
	bra	not_enabled
 | 
						|
 | 
						|
operr_byte:
 | 
						|
	moveql	#1,%d1		|write size to d1
 | 
						|
	moveb	STAG(%a6),%d0	|test stag for nan
 | 
						|
	andib	#0xe0,%d0		|clr all but tag
 | 
						|
	cmpib	#0x60,%d0		|check for nan
 | 
						|
	beqs	operr_nan
 | 
						|
	cmpil	#0xffffff80,FPTEMP_LO(%a6) |test if ls lword is special
 | 
						|
	bnes	chkberr		|if not equal, check for incorrect operr
 | 
						|
	bsr	check_upper	|check if exp and ms mant are special
 | 
						|
	tstl	%d0
 | 
						|
	bnes	chkberr		|if d0 is true, check for incorrect operr
 | 
						|
	movel	#0x80000000,%d0	|store special case result
 | 
						|
	bsr	operr_store
 | 
						|
	bra	not_enabled	|clean and exit
 | 
						|
|
 | 
						|
|	CHECK FOR INCORRECTLY GENERATED OPERR EXCEPTION HERE
 | 
						|
|
 | 
						|
chkberr:
 | 
						|
	movew	FPTEMP_EX(%a6),%d0
 | 
						|
	andw	#0x7FFF,%d0	|ignore sign bit
 | 
						|
	cmpw	#0x3FFE,%d0	|this is the only possible exponent value
 | 
						|
	bnes	store_max
 | 
						|
	movel	FPTEMP_LO(%a6),%d0
 | 
						|
	asll	#8,%d0
 | 
						|
	swap	%d0
 | 
						|
	bsr	operr_store
 | 
						|
	bra	not_enabled
 | 
						|
 | 
						|
|
 | 
						|
| This operr condition is not of the special case.  Set operr
 | 
						|
| and aiop and write the portion of the nan to memory for the
 | 
						|
| given size.
 | 
						|
|
 | 
						|
operr_nan:
 | 
						|
	orl	#opaop_mask,USER_FPSR(%a6) |set operr & aiop
 | 
						|
 | 
						|
	movel	ETEMP_HI(%a6),%d0	|output will be from upper 32 bits
 | 
						|
	bsr	operr_store
 | 
						|
	bra	end_operr
 | 
						|
|
 | 
						|
| Store_max loads the max pos or negative for the size, sets
 | 
						|
| the operr and aiop bits, and clears inex and ainex, incorrectly
 | 
						|
| set by the 040.
 | 
						|
|
 | 
						|
store_max:
 | 
						|
	orl	#opaop_mask,USER_FPSR(%a6) |set operr & aiop
 | 
						|
	bclrb	#inex2_bit,FPSR_EXCEPT(%a6)
 | 
						|
	bclrb	#ainex_bit,FPSR_AEXCEPT(%a6)
 | 
						|
	fmovel	#0,%FPSR
 | 
						|
 | 
						|
	tstw	FPTEMP_EX(%a6)	|check sign
 | 
						|
	blts	load_neg
 | 
						|
	movel	#0x7fffffff,%d0
 | 
						|
	bsr	operr_store
 | 
						|
	bra	end_operr
 | 
						|
load_neg:
 | 
						|
	movel	#0x80000000,%d0
 | 
						|
	bsr	operr_store
 | 
						|
	bra	end_operr
 | 
						|
 | 
						|
|
 | 
						|
| This routine stores the data in d0, for the given size in d1,
 | 
						|
| to memory or data register as required.  A read of the fline
 | 
						|
| is required to determine the destination.
 | 
						|
|
 | 
						|
operr_store:
 | 
						|
	movel	%d0,L_SCR1(%a6)	|move write data to L_SCR1
 | 
						|
	movel	%d1,-(%a7)	|save register size
 | 
						|
	bsrl	get_fline	|fline returned in d0
 | 
						|
	movel	(%a7)+,%d1
 | 
						|
	bftst	%d0{#26:#3}		|if mode is zero, dest is Dn
 | 
						|
	bnes	dest_mem
 | 
						|
|
 | 
						|
| Destination is Dn.  Get register number from d0. Data is on
 | 
						|
| the stack at (a7). D1 has size: 1=byte,2=word,4=long/single
 | 
						|
|
 | 
						|
	andil	#7,%d0		|isolate register number
 | 
						|
	cmpil	#4,%d1
 | 
						|
	beqs	op_long		|the most frequent case
 | 
						|
	cmpil	#2,%d1
 | 
						|
	bnes	op_con
 | 
						|
	orl	#8,%d0
 | 
						|
	bras	op_con
 | 
						|
op_long:
 | 
						|
	orl	#0x10,%d0
 | 
						|
op_con:
 | 
						|
	movel	%d0,%d1		|format size:reg for reg_dest
 | 
						|
	bral	reg_dest	|call to reg_dest returns to caller
 | 
						|
|				;of operr_store
 | 
						|
|
 | 
						|
| Destination is memory.  Get <ea> from integer exception frame
 | 
						|
| and call mem_write.
 | 
						|
|
 | 
						|
dest_mem:
 | 
						|
	leal	L_SCR1(%a6),%a0	|put ptr to write data in a0
 | 
						|
	movel	EXC_EA(%a6),%a1	|put user destination address in a1
 | 
						|
	movel	%d1,%d0		|put size in d0
 | 
						|
	bsrl	mem_write
 | 
						|
	rts
 | 
						|
|
 | 
						|
| Check the exponent for $c000 and the upper 32 bits of the
 | 
						|
| mantissa for $ffffffff.  If both are true, return d0 clr
 | 
						|
| and store the lower n bits of the least lword of FPTEMP
 | 
						|
| to d0 for write out.  If not, it is a real operr, and set d0.
 | 
						|
|
 | 
						|
check_upper:
 | 
						|
	cmpil	#0xffffffff,FPTEMP_HI(%a6) |check if first byte is all 1's
 | 
						|
	bnes	true_operr	|if not all 1's then was true operr
 | 
						|
	cmpiw	#0xc000,FPTEMP_EX(%a6) |check if incorrectly signalled
 | 
						|
	beqs	not_true_operr	|branch if not true operr
 | 
						|
	cmpiw	#0xbfff,FPTEMP_EX(%a6) |check if incorrectly signalled
 | 
						|
	beqs	not_true_operr	|branch if not true operr
 | 
						|
true_operr:
 | 
						|
	movel	#1,%d0		|signal real operr
 | 
						|
	rts
 | 
						|
not_true_operr:
 | 
						|
	clrl	%d0		|signal no real operr
 | 
						|
	rts
 | 
						|
 | 
						|
|
 | 
						|
| End_operr tests for operr enabled.  If not, it cleans up the stack
 | 
						|
| and does an rte.  If enabled, it cleans up the stack and branches
 | 
						|
| to the kernel operr handler with only the integer exception
 | 
						|
| frame on the stack and the fpu in the original exceptional state
 | 
						|
| with correct data written to the destination.
 | 
						|
|
 | 
						|
end_operr:
 | 
						|
	btstb		#operr_bit,FPCR_ENABLE(%a6)
 | 
						|
	beqs		not_enabled
 | 
						|
enabled:
 | 
						|
	moveml		USER_DA(%a6),%d0-%d1/%a0-%a1
 | 
						|
	fmovemx	USER_FP0(%a6),%fp0-%fp3
 | 
						|
	fmoveml	USER_FPCR(%a6),%fpcr/%fpsr/%fpiar
 | 
						|
	frestore	(%a7)+
 | 
						|
	unlk		%a6
 | 
						|
	bral		real_operr
 | 
						|
 | 
						|
not_enabled:
 | 
						|
|
 | 
						|
| It is possible to have either inex2 or inex1 exceptions with the
 | 
						|
| operr.  If the inex enable bit is set in the FPCR, and either
 | 
						|
| inex2 or inex1 occurred, we must clean up and branch to the
 | 
						|
| real inex handler.
 | 
						|
|
 | 
						|
ck_inex:
 | 
						|
	moveb	FPCR_ENABLE(%a6),%d0
 | 
						|
	andb	FPSR_EXCEPT(%a6),%d0
 | 
						|
	andib	#0x3,%d0
 | 
						|
	beq	operr_exit
 | 
						|
|
 | 
						|
| Inexact enabled and reported, and we must take an inexact exception.
 | 
						|
|
 | 
						|
take_inex:
 | 
						|
	moveb		#INEX_VEC,EXC_VEC+1(%a6)
 | 
						|
	movel		USER_FPSR(%a6),FPSR_SHADOW(%a6)
 | 
						|
	orl		#sx_mask,E_BYTE(%a6)
 | 
						|
	moveml		USER_DA(%a6),%d0-%d1/%a0-%a1
 | 
						|
	fmovemx	USER_FP0(%a6),%fp0-%fp3
 | 
						|
	fmoveml	USER_FPCR(%a6),%fpcr/%fpsr/%fpiar
 | 
						|
	frestore	(%a7)+
 | 
						|
	unlk		%a6
 | 
						|
	bral		real_inex
 | 
						|
|
 | 
						|
| Since operr is only an E1 exception, there is no need to frestore
 | 
						|
| any state back to the fpu.
 | 
						|
|
 | 
						|
operr_exit:
 | 
						|
	moveml		USER_DA(%a6),%d0-%d1/%a0-%a1
 | 
						|
	fmovemx	USER_FP0(%a6),%fp0-%fp3
 | 
						|
	fmoveml	USER_FPCR(%a6),%fpcr/%fpsr/%fpiar
 | 
						|
	unlk		%a6
 | 
						|
	bral		fpsp_done
 | 
						|
 | 
						|
	|end
 |