360 lines
11 KiB
ArmAsm
360 lines
11 KiB
ArmAsm
/*
|
|
#
|
|
# $NetBSD: fnetbsd.S,v 1.5 2000/11/30 21:00:51 scw Exp $
|
|
#
|
|
#~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
|
# MOTOROLA MICROPROCESSOR & MEMORY TECHNOLOGY GROUP
|
|
# M68000 Hi-Performance Microprocessor Division
|
|
# M68060 Software Package Production Release
|
|
#
|
|
# M68060 Software Package Copyright (C) 1993, 1994, 1995, 1996 Motorola Inc.
|
|
# All rights reserved.
|
|
#
|
|
# THE SOFTWARE is provided on an "AS IS" basis and without warranty.
|
|
# To the maximum extent permitted by applicable law,
|
|
# MOTOROLA DISCLAIMS ALL WARRANTIES WHETHER EXPRESS OR IMPLIED,
|
|
# INCLUDING IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS
|
|
# FOR A PARTICULAR PURPOSE and any warranty against infringement with
|
|
# regard to the SOFTWARE (INCLUDING ANY MODIFIED VERSIONS THEREOF)
|
|
# and any accompanying written materials.
|
|
#
|
|
# To the maximum extent permitted by applicable law,
|
|
# IN NO EVENT SHALL MOTOROLA BE LIABLE FOR ANY DAMAGES WHATSOEVER
|
|
# (INCLUDING WITHOUT LIMITATION, DAMAGES FOR LOSS OF BUSINESS PROFITS,
|
|
# BUSINESS INTERRUPTION, LOSS OF BUSINESS INFORMATION, OR OTHER PECUNIARY LOSS)
|
|
# ARISING OF THE USE OR INABILITY TO USE THE SOFTWARE.
|
|
#
|
|
# Motorola assumes no responsibility for the maintenance and support
|
|
# of the SOFTWARE.
|
|
#
|
|
# You are hereby granted a copyright license to use, modify, and distribute the
|
|
# SOFTWARE so long as this entire notice is retained without alteration
|
|
# in any modified and/or redistributed versions, and that such modified
|
|
# versions are clearly identified as such.
|
|
# No licenses are granted by implication, estoppel or otherwise under any
|
|
# patents or trademarks of Motorola, Inc.
|
|
#~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
|
#
|
|
# Derived from:
|
|
# fskeleton.s
|
|
#
|
|
# This file contains:
|
|
# (1) example "Call-out"s
|
|
# (2) example package entry code
|
|
# (3) example "Call-out" table
|
|
#
|
|
|
|
|
|
#################################
|
|
# (1) EXAMPLE CALL-OUTS #
|
|
# #
|
|
# _060_fpsp_done() #
|
|
# _060_real_ovfl() #
|
|
# _060_real_unfl() #
|
|
# _060_real_operr() #
|
|
# _060_real_snan() #
|
|
# _060_real_dz() #
|
|
# _060_real_inex() #
|
|
# _060_real_bsun() #
|
|
# _060_real_fline() #
|
|
# _060_real_fpu_disabled() #
|
|
# _060_real_trap() #
|
|
#################################
|
|
*/
|
|
|
|
/*
|
|
#
|
|
# _060_fpsp_done():
|
|
#
|
|
# This is the main exit point for the 68060 Floating-Point
|
|
# Software Package. For a normal exit, all 060FPSP routines call this
|
|
# routine. The operating system can do system dependent clean-up or
|
|
# simply execute an "rte" as with the sample code below.
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_fpsp_done)
|
|
rte
|
|
|
|
/*
|
|
#
|
|
# _060_real_ovfl():
|
|
#
|
|
# This is the exit point for the 060FPSP when an enabled overflow exception
|
|
# is present. The routine below should point to the operating system handler
|
|
# for enabled overflow conditions. The exception stack frame is an overflow
|
|
# stack frame. The FP state frame holds the EXCEPTIONAL OPERAND.
|
|
#
|
|
# The sample routine below simply clears the exception status bit and
|
|
# does an "rte".
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_ovfl)
|
|
fsave %sp@-
|
|
movew #0x6000,%sp@(0x2)
|
|
frestore %sp@+
|
|
jmp _C_LABEL(fpfault)
|
|
|
|
/*
|
|
#
|
|
# _060_real_unfl():
|
|
#
|
|
# This is the exit point for the 060FPSP when an enabled underflow exception
|
|
# is present. The routine below should point to the operating system handler
|
|
# for enabled underflow conditions. The exception stack frame is an underflow
|
|
# stack frame. The FP state frame holds the EXCEPTIONAL OPERAND.
|
|
#
|
|
# The sample routine below simply clears the exception status bit and
|
|
# does an "rte".
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_unfl)
|
|
fsave %sp@-
|
|
movew #0x6000,%sp@(0x2)
|
|
frestore %sp@+
|
|
jmp _C_LABEL(fpfault)
|
|
|
|
/*
|
|
#
|
|
# _060_real_operr():
|
|
#
|
|
# This is the exit point for the 060FPSP when an enabled operand error exception
|
|
# is present. The routine below should point to the operating system handler
|
|
# for enabled operand error exceptions. The exception stack frame is an operand error
|
|
# stack frame. The FP state frame holds the source operand of the faulting
|
|
# instruction.
|
|
#
|
|
# The sample routine below simply clears the exception status bit and
|
|
# does an "rte".
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_operr)
|
|
fsave %sp@-
|
|
movew #0x6000,%sp@(0x2)
|
|
frestore %sp@+
|
|
jmp _C_LABEL(fpfault)
|
|
|
|
/*
|
|
#
|
|
# _060_real_snan():
|
|
#
|
|
# This is the exit point for the 060FPSP when an enabled signalling NaN exception
|
|
# is present. The routine below should point to the operating system handler
|
|
# for enabled signalling NaN exceptions. The exception stack frame is a signalling NaN
|
|
# stack frame. The FP state frame holds the source operand of the faulting
|
|
# instruction.
|
|
#
|
|
# The sample routine below simply clears the exception status bit and
|
|
# does an "rte".
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_snan)
|
|
fsave %sp@-
|
|
movew #0x6000,%sp@(0x2)
|
|
frestore %sp@+
|
|
jmp _C_LABEL(fpfault)
|
|
|
|
/*
|
|
#
|
|
# _060_real_dz():
|
|
#
|
|
# This is the exit point for the 060FPSP when an enabled divide-by-zero exception
|
|
# is present. The routine below should point to the operating system handler
|
|
# for enabled divide-by-zero exceptions. The exception stack frame is a divide-by-zero
|
|
# stack frame. The FP state frame holds the source operand of the faulting
|
|
# instruction.
|
|
#
|
|
# The sample routine below simply clears the exception status bit and
|
|
# does an "rte".
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_dz)
|
|
fsave %sp@-
|
|
movew #0x6000,%sp@(0x2)
|
|
frestore %sp@+
|
|
jmp _C_LABEL(fpfault)
|
|
|
|
/*
|
|
#
|
|
# _060_real_inex():
|
|
#
|
|
# This is the exit point for the 060FPSP when an enabled inexact exception
|
|
# is present. The routine below should point to the operating system handler
|
|
# for enabled inexact exceptions. The exception stack frame is an inexact
|
|
# stack frame. The FP state frame holds the source operand of the faulting
|
|
# instruction.
|
|
#
|
|
# The sample routine below simply clears the exception status bit and
|
|
# does an "rte".
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_inex)
|
|
fsave %sp@-
|
|
movew #0x6000,%sp@(0x2)
|
|
frestore %sp@+
|
|
jmp _C_LABEL(fpfault)
|
|
|
|
/*
|
|
#
|
|
# _060_real_bsun():
|
|
#
|
|
# This is the exit point for the 060FPSP when an enabled bsun exception
|
|
# is present. The routine below should point to the operating system handler
|
|
# for enabled bsun exceptions. The exception stack frame is a bsun
|
|
# stack frame.
|
|
#
|
|
# The sample routine below clears the exception status bit, clears the NaN
|
|
# bit in the FPSR, and does an "rte". The instruction that caused the
|
|
# bsun will now be re-executed but with the NaN FPSR bit cleared.
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_bsun)
|
|
fsave %sp@-
|
|
|
|
fmovel %fpsr,%sp@-
|
|
andib #0xfe,%sp@
|
|
fmovel %sp@+,%fpsr
|
|
|
|
addl #0xc,%sp
|
|
jmp _C_LABEL(fpfault)
|
|
|
|
/*
|
|
#
|
|
# _060_real_fline():
|
|
#
|
|
# This is the exit point for the 060FPSP when an F-Line Illegal exception is
|
|
# encountered. Three different types of exceptions can enter the F-Line exception
|
|
# vector number 11: FP Unimplemented Instructions, FP implemented instructions when
|
|
# the FPU is disabled, and F-Line Illegal instructions. The 060FPSP module
|
|
# _fpsp_fline() distinguishes between the three and acts appropriately. F-Line
|
|
# Illegals branch here.
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_fline)
|
|
jmp _C_LABEL(fpfault)
|
|
|
|
/*
|
|
#
|
|
# _060_real_fpu_disabled():
|
|
#
|
|
# This is the exit point for the 060FPSP when an FPU disabled exception is
|
|
# encountered. Three different types of exceptions can enter the F-Line exception
|
|
# vector number 11: FP Unimplemented Instructions, FP implemented instructions when
|
|
# the FPU is disabled, and F-Line Illegal instructions. The 060FPSP module
|
|
# _fpsp_fline() distinguishes between the three and acts appropriately. FPU disabled
|
|
# exceptions branch here.
|
|
#
|
|
# The sample code below enables the FPU, sets the PC field in the exception stack
|
|
# frame to the PC of the instruction causing the exception, and does an "rte".
|
|
# The execution of the instruction then proceeds with an enabled floating-point
|
|
# unit.
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_fpu_disabled)
|
|
movel %d0,%sp@- |# enabled the fpu
|
|
|
|
.short 0x4e7a,0x0808 |* movec.l pcr,d0
|
|
bclr #0x1,%d0
|
|
.short 0x4e7b,0x0808 |* movec.l d0,pcr
|
|
movel %sp@+,%d0
|
|
|
|
movel %sp@(0xc),%sp@(0x2) |# set "Current PC"
|
|
rte
|
|
|
|
/*
|
|
#
|
|
# _060_real_trap():
|
|
#
|
|
# This is the exit point for the 060FPSP when an emulated "ftrapcc" instruction
|
|
# discovers that the trap condition is true and it should branch to the operating
|
|
# system handler for the trap exception vector number 7.
|
|
#
|
|
# The sample code below simply executes an "rte".
|
|
#
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_real_trap)
|
|
rte
|
|
|
|
/*
|
|
#############################################################################
|
|
|
|
##################################
|
|
# (2) EXAMPLE PACKAGE ENTRY CODE #
|
|
##################################
|
|
*/
|
|
ASENTRY_NOPROFILE(_060_fpsp_snan)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x00
|
|
|
|
ASENTRY_NOPROFILE(_060_fpsp_operr)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x08
|
|
|
|
ASENTRY_NOPROFILE(_060_fpsp_ovfl)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x10
|
|
|
|
ASENTRY_NOPROFILE(_060_fpsp_unfl)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x18
|
|
|
|
ASENTRY_NOPROFILE(_060_fpsp_dz)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x20
|
|
|
|
ASENTRY_NOPROFILE(_060_fpsp_inex)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x28
|
|
|
|
ASENTRY_NOPROFILE(_060_fpsp_fline)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x30
|
|
|
|
ASENTRY_NOPROFILE(_060_fpsp_unsupp)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x38
|
|
|
|
ASENTRY_NOPROFILE(_060_fpsp_effadd)
|
|
bral _C_LABEL(FP_CALL_TOP)+0x80+0x40
|
|
|
|
/*
|
|
#############################################################################
|
|
|
|
################################
|
|
# (3) EXAMPLE CALL-OUT SECTION #
|
|
################################
|
|
|
|
# The size of this section MUST be 128 bytes!!!
|
|
*/
|
|
GLOBAL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_bsun)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_snan)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_operr)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_ovfl)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_unfl)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_dz)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_inex)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_fline)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_fpu_disabled)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_trap)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_trace)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_real_access)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_fpsp_done)-_C_LABEL(FP_CALL_TOP)
|
|
|
|
.long 0x00000000,0x00000000,0x00000000
|
|
|
|
.long _ASM_LABEL(_060_imem_read)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_dmem_read)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_dmem_write)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_imem_read_word)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_imem_read_long)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_dmem_read_byte)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_dmem_read_word)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_dmem_read_long)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_dmem_write_byte)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_dmem_write_word)-_C_LABEL(FP_CALL_TOP)
|
|
.long _ASM_LABEL(_060_dmem_write_long)-_C_LABEL(FP_CALL_TOP)
|
|
|
|
.long 0x00000000
|
|
|
|
.long 0x00000000,0x00000000,0x00000000,0x00000000
|
|
|
|
/*
|
|
#############################################################################
|
|
|
|
# 060 FPSP KERNEL PACKAGE NEEDS TO GO HERE!!!
|
|
*/
|
|
|
|
#include "fpsp.S"
|