Quelle  x_operr.S   Sprache: Sparc

|
| 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