mirror of
https://github.com/irmen/prog8.git
synced 2024-09-04 13:29:54 +00:00
232 lines
4.1 KiB
Lua
232 lines
4.1 KiB
Lua
floats {
|
|
; the floating point functions shared across compiler targets
|
|
%option merge, no_symbol_prefixing
|
|
|
|
asmsub print_f(float value @FAC1) clobbers(A,X,Y) {
|
|
; ---- prints the floating point value (without a newline). No leading space (unlike BASIC)!
|
|
%asm {{
|
|
jsr str_f
|
|
ldy #0
|
|
- lda (P8ZP_SCRATCH_W1),y
|
|
beq +
|
|
jsr cbm.CHROUT
|
|
iny
|
|
bne -
|
|
+ rts
|
|
}}
|
|
}
|
|
|
|
asmsub str_f(float value @FAC1) clobbers(X) -> str @AY {
|
|
; ---- converts the floating point value to a string. No leading space!
|
|
%asm {{
|
|
jsr FOUT
|
|
sta P8ZP_SCRATCH_W1
|
|
sty P8ZP_SCRATCH_W1+1
|
|
ldy #0
|
|
lda (P8ZP_SCRATCH_W1),y
|
|
cmp #' '
|
|
bne +
|
|
inc P8ZP_SCRATCH_W1
|
|
bne +
|
|
inc P8ZP_SCRATCH_W1+1
|
|
+ lda P8ZP_SCRATCH_W1
|
|
ldy P8ZP_SCRATCH_W1+1
|
|
rts
|
|
}}
|
|
}
|
|
|
|
sub pow(float value, float power) -> float {
|
|
%asm {{
|
|
stx P8ZP_SCRATCH_W1
|
|
sty P8ZP_SCRATCH_W1+1
|
|
lda #<value
|
|
ldy #>value
|
|
jsr floats.CONUPK
|
|
lda #<power
|
|
ldy #>power
|
|
jsr floats.FPWR
|
|
ldx P8ZP_SCRATCH_W1
|
|
ldy P8ZP_SCRATCH_W1+1
|
|
rts
|
|
}}
|
|
}
|
|
|
|
sub sin(float angle) -> float {
|
|
%asm {{
|
|
lda #<angle
|
|
ldy #>angle
|
|
jsr MOVFM
|
|
jmp SIN
|
|
}}
|
|
}
|
|
|
|
sub cos(float angle) -> float {
|
|
%asm {{
|
|
lda #<angle
|
|
ldy #>angle
|
|
jsr MOVFM
|
|
jmp COS
|
|
rts
|
|
}}
|
|
}
|
|
|
|
sub tan(float value) -> float {
|
|
%asm {{
|
|
lda #<value
|
|
ldy #>value
|
|
jsr MOVFM
|
|
jmp TAN
|
|
}}
|
|
}
|
|
|
|
sub atan(float value) -> float {
|
|
%asm {{
|
|
lda #<value
|
|
ldy #>value
|
|
jsr MOVFM
|
|
jmp ATN
|
|
}}
|
|
}
|
|
|
|
sub ln(float value) -> float {
|
|
%asm {{
|
|
lda #<value
|
|
ldy #>value
|
|
jsr MOVFM
|
|
jmp LOG
|
|
}}
|
|
}
|
|
|
|
sub log2(float value) -> float {
|
|
%asm {{
|
|
lda #<value
|
|
ldy #>value
|
|
jsr MOVFM
|
|
jsr LOG
|
|
jsr MOVEF
|
|
lda #<FL_LOG2_const
|
|
ldy #>FL_LOG2_const
|
|
jsr MOVFM
|
|
jmp FDIVT
|
|
}}
|
|
}
|
|
|
|
sub rad(float angle) -> float {
|
|
; -- convert degrees to radians (d * pi / 180)
|
|
%asm {{
|
|
lda #<angle
|
|
ldy #>angle
|
|
jsr MOVFM
|
|
lda #<_pi_div_180
|
|
ldy #>_pi_div_180
|
|
jmp FMULT
|
|
_pi_div_180 .byte 123, 14, 250, 53, 18 ; pi / 180
|
|
}}
|
|
}
|
|
|
|
sub deg(float angle) -> float {
|
|
; -- convert radians to degrees (d * (1/ pi * 180))
|
|
%asm {{
|
|
lda #<angle
|
|
ldy #>angle
|
|
jsr MOVFM
|
|
lda #<_one_over_pi_div_180
|
|
ldy #>_one_over_pi_div_180
|
|
jmp FMULT
|
|
rts
|
|
_one_over_pi_div_180 .byte 134, 101, 46, 224, 211 ; 1 / (pi * 180)
|
|
}}
|
|
}
|
|
|
|
sub round(float value) -> float {
|
|
%asm {{
|
|
lda #<value
|
|
ldy #>value
|
|
jsr MOVFM
|
|
jsr FADDH
|
|
jmp INT
|
|
}}
|
|
}
|
|
|
|
sub floor(float value) -> float {
|
|
%asm {{
|
|
lda #<value
|
|
ldy #>value
|
|
jsr MOVFM
|
|
jmp INT
|
|
}}
|
|
}
|
|
|
|
sub ceil(float value) -> float {
|
|
; -- ceil: tr = int(f); if tr==f -> return else return tr+1
|
|
%asm {{
|
|
lda #<value
|
|
ldy #>value
|
|
jsr MOVFM
|
|
ldx #<fmath_float1
|
|
ldy #>fmath_float1
|
|
jsr MOVMF
|
|
jsr INT
|
|
lda #<fmath_float1
|
|
ldy #>fmath_float1
|
|
jsr FCOMP
|
|
cmp #0
|
|
beq +
|
|
lda #<FL_ONE_const
|
|
ldy #>FL_ONE_const
|
|
jsr FADD
|
|
+ rts
|
|
}}
|
|
}
|
|
|
|
sub rndseedf(float seed) {
|
|
if seed>0
|
|
seed = -seed ; make sure fp seed is always negative
|
|
|
|
%asm {{
|
|
lda #<seed
|
|
ldy #>seed
|
|
jsr MOVFM ; load float into fac1
|
|
lda #-1
|
|
jmp floats.RND
|
|
}}
|
|
}
|
|
|
|
|
|
sub minf(float f1, float f2) -> float {
|
|
if f1<f2
|
|
return f1
|
|
return f2
|
|
}
|
|
|
|
|
|
sub maxf(float f1, float f2) -> float {
|
|
if f1>f2
|
|
return f1
|
|
return f2
|
|
}
|
|
|
|
|
|
sub clampf(float value, float minimum, float maximum) -> float {
|
|
if value>maximum
|
|
value=maximum
|
|
if value>minimum
|
|
return value
|
|
return minimum
|
|
}
|
|
|
|
inline asmsub push(float value @FAC1) {
|
|
%asm {{
|
|
jsr floats.pushFAC1
|
|
}}
|
|
}
|
|
|
|
inline asmsub pop() -> float @FAC1 {
|
|
%asm {{
|
|
clc
|
|
jsr floats.popFAC
|
|
}}
|
|
}
|
|
|
|
}
|