mirror of https://github.com/lianthony/NT4.0
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
174 lines
3.0 KiB
174 lines
3.0 KiB
;/***
|
|
;*trig.a - sin, cos, tan functions
|
|
;*
|
|
;* Copyright (c) 1991-1991, Microsoft Corporation. All rights reserved.
|
|
;*
|
|
;*Purpose:
|
|
;* Trig functions to be used with M68K version
|
|
;*
|
|
;*Revision History:
|
|
;* 05-07-92 PLM MAC version
|
|
;*
|
|
;*******************************************************************************/
|
|
|
|
#include <traps.a>
|
|
#ifdef SANE
|
|
#include <sane.a>
|
|
#endif
|
|
|
|
externW _errno
|
|
|
|
;double sin(double x)
|
|
|
|
cProc sin,PUBLIC
|
|
parmQ x
|
|
localW fpstat
|
|
localV xlocalx,10
|
|
localW xtestw
|
|
cBegin sin
|
|
#ifdef SANE
|
|
pea fpstat
|
|
move.w #FOPROCENTRY,-(a7)
|
|
FP68K ;save current status & set default control
|
|
|
|
pea x
|
|
pea xlocalx
|
|
move.w #FFDBL+FOZ2X,-(a7)
|
|
FP68K ;convert to extended
|
|
|
|
pea xlocalx
|
|
move.w #FOSINX,-(a7)
|
|
Elems68K ;sin x
|
|
|
|
lea xlocalx,a1
|
|
move.w (a1)+,d0 ;load result for return
|
|
move.l (a1)+,d1
|
|
move.l (a1),a0
|
|
|
|
pea fpstat
|
|
move.w #FOPROCEXIT,-(a7)
|
|
FP68K ;set result status & restore control
|
|
#else
|
|
fmove.l fpcr,d0
|
|
|
|
fmove.d x, fp0
|
|
ftst.x fp0 ;see if it is a valid number
|
|
fmove.l fpsr, d1 ;get status word
|
|
and.l #0x03007c00, d1 ;see if we get an exception
|
|
cmp.l #0, d1
|
|
bne domain_error_fpu
|
|
|
|
fmove.l #0,fpcr
|
|
fsin.d x,fp0
|
|
jra to_end_fpu
|
|
|
|
domain_error_fpu:
|
|
move.l #33, _errno
|
|
to_end_fpu:
|
|
fmove.l d0,fpcr
|
|
#endif
|
|
cEnd sin
|
|
|
|
;double cos(double x)
|
|
|
|
cProc cos,PUBLIC
|
|
parmQ x
|
|
localW fpstat
|
|
localV xlocalx,10
|
|
localW xtestw
|
|
cBegin cos
|
|
#ifdef SANE
|
|
pea fpstat
|
|
move.w #FOPROCENTRY,-(a7)
|
|
FP68K ;save current status & set default control
|
|
|
|
pea x
|
|
pea xlocalx
|
|
move.w #FFDBL+FOZ2X,-(a7)
|
|
FP68K ;convert to extended
|
|
|
|
pea xlocalx
|
|
move.w #FOCOSX,-(a7)
|
|
Elems68K ;cos x
|
|
|
|
lea xlocalx,a1
|
|
move.w (a1)+,d0 ;load result for return
|
|
move.l (a1)+,d1
|
|
move.l (a1),a0
|
|
|
|
pea fpstat
|
|
move.w #FOPROCEXIT,-(a7)
|
|
FP68K ;set result status & restore control
|
|
#else
|
|
fmove.l fpcr,d0
|
|
|
|
fmove.d x, fp0
|
|
ftst.x fp0 ;see if it is a valid number
|
|
fmove.l fpsr, d1 ;get status word
|
|
and.l #0x03007c00, d1 ;see if we get an exception
|
|
cmp.l #0, d1
|
|
bne domain_error_fpu2
|
|
|
|
fmove.l #0,fpcr
|
|
fcos.d x,fp0
|
|
jra to_end_fpu2
|
|
|
|
domain_error_fpu2:
|
|
move.l #33, _errno
|
|
to_end_fpu2:
|
|
fmove.l d0,fpcr
|
|
#endif
|
|
cEnd cos
|
|
|
|
;double tan(double x)
|
|
|
|
|
|
cProc tan,PUBLIC
|
|
parmQ x
|
|
localW fpstat
|
|
localV xlocalx,10
|
|
localW xtestw
|
|
cBegin tan
|
|
#ifdef SANE
|
|
pea fpstat
|
|
move.w #FOPROCENTRY,-(a7)
|
|
FP68K ;save current status & set default control
|
|
pea x
|
|
pea xlocalx
|
|
move.w #FFDBL+FOZ2X,-(a7)
|
|
FP68K ;convert to extended
|
|
|
|
pea xlocalx
|
|
move.w #FOTANX,-(a7)
|
|
Elems68K ;ln x
|
|
|
|
lea xlocalx,a1
|
|
move.w (a1)+,d0 ;load result for return
|
|
move.l (a1)+,d1
|
|
move.l (a1),a0
|
|
|
|
pea fpstat
|
|
move.w #FOPROCEXIT,-(a7)
|
|
FP68K ;set result status & restore control
|
|
#else
|
|
fmove.l fpcr,d0
|
|
|
|
fmove.d x, fp0
|
|
ftst.x fp0 ;see if it is a valid number
|
|
fmove.l fpsr, d1 ;get status word
|
|
and.l #0x03007c00, d1 ;see if we get an exception
|
|
cmp.l #0, d1
|
|
bne domain_error_fpu3
|
|
|
|
fmove.l #0,fpcr
|
|
ftan.d x,fp0
|
|
jra to_end_fpu3
|
|
|
|
domain_error_fpu3:
|
|
move.l #33, _errno
|
|
to_end_fpu3:
|
|
fmove.l d0,fpcr
|
|
#endif
|
|
cEnd tan
|
|
|
|
|