URL
https://opencores.org/ocsvn/openrisc/openrisc/trunk
Subversion Repositories openrisc
[/] [openrisc/] [trunk/] [rtos/] [rtems/] [c/] [src/] [lib/] [libcpu/] [m68k/] [m68040/] [fpsp/] [x_unsupp.S] - Rev 30
Go to most recent revision | Compare with Previous | Blame | View Log
//
// $Id: x_unsupp.S,v 1.2 2001-09-27 12:01:22 chris Exp $
//
// 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
//
// THIS IS UNPUBLISHED PROPRIETARY SOURCE CODE OF MOTOROLA
// The copyright notice above does not evidence any
// actual or intended publication of such source code.
X_UNSUPP: //idnt 2,1 | Motorola 040 Floating Point Software Package
|section 8
#include "fpsp.defs"
|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
Go to most recent revision | Compare with Previous | Blame | View Log