mirror of
https://github.com/irmen/prog8.git
synced 2024-09-11 00:54:31 +00:00
184 lines
3.6 KiB
Plaintext
184 lines
3.6 KiB
Plaintext
; IL65 internal library routines
|
|
;
|
|
; Written by Irmen de Jong (irmen@razorvine.net)
|
|
; License: GNU GPL 3.0, see LICENSE
|
|
;
|
|
; indent format: TABS, size=8
|
|
|
|
|
|
~ il65_lib_zp {
|
|
; note: separate block so the 64tass assembler can remove this when no zp restore is required
|
|
|
|
asm {
|
|
|
|
; ---- store the Zeropage in a backup area
|
|
save_zeropage
|
|
sei
|
|
ldx #2
|
|
- lda $00,x
|
|
sta zp_backup,x
|
|
inx
|
|
bne -
|
|
cli
|
|
rts
|
|
|
|
restore_zeropage
|
|
php
|
|
pha
|
|
txa
|
|
pha
|
|
sei
|
|
|
|
lda $a0 ; save the current jiffy clock
|
|
sta zp_backup+$a0
|
|
lda $a1
|
|
sta zp_backup+$a1
|
|
lda $a2
|
|
sta zp_backup+$a2
|
|
|
|
ldx #2
|
|
- lda zp_backup-2,x
|
|
sta $00,x
|
|
inx
|
|
bne -
|
|
cli
|
|
pla
|
|
tax
|
|
pla
|
|
plp
|
|
rts
|
|
|
|
zp_backup .fill 256, 0
|
|
|
|
}
|
|
}
|
|
|
|
|
|
~ il65_lib {
|
|
; note: the following ZP scratch registers must be the same as in c64lib
|
|
memory .byte SCRATCH_ZP1 = $02 ; scratch register #1 in ZP
|
|
memory .byte SCRATCH_ZP2 = $03 ; scratch register #2 in ZP
|
|
memory .word SCRATCH_ZPWORD1 = $fb ; scratch word in ZP ($fb/$fc)
|
|
memory .word SCRATCH_ZPWORD2 = $fd ; scratch word in ZP ($fd/$fe)
|
|
|
|
|
|
asm {
|
|
|
|
; ---- jmp (indirect) routines for register pairs containing the indirect address
|
|
jsr_indirect_nozpuse_AX
|
|
sta jsr_indirect_tmp
|
|
stx jsr_indirect_tmp+1
|
|
jmp (jsr_indirect_tmp)
|
|
jsr_indirect_nozpuse_AY
|
|
sta jsr_indirect_tmp
|
|
sty jsr_indirect_tmp+1
|
|
jmp (jsr_indirect_tmp)
|
|
jsr_indirect_nozpuse_XY
|
|
stx jsr_indirect_tmp
|
|
sty jsr_indirect_tmp+1
|
|
jmp (jsr_indirect_tmp)
|
|
jsr_indirect_tmp
|
|
.byte 0, 0
|
|
|
|
|
|
jsr_indirect_AX
|
|
sta SCRATCH_ZP1
|
|
stx SCRATCH_ZP2
|
|
jmp (SCRATCH_ZP1)
|
|
jsr_indirect_AY
|
|
sta SCRATCH_ZP1
|
|
sty SCRATCH_ZP2
|
|
jmp (SCRATCH_ZP1)
|
|
jsr_indirect_XY
|
|
stx SCRATCH_ZP1
|
|
sty SCRATCH_ZP2
|
|
jmp (SCRATCH_ZP1)
|
|
|
|
}
|
|
|
|
|
|
asm {
|
|
|
|
; ---- copy a 5 byte MFLT floating point variable to another place
|
|
; input: X/Y = source address, SCRATCH_ZPWORD1 = destination address
|
|
copy_mflt stx SCRATCH_ZP1
|
|
sty SCRATCH_ZPWORD1+1
|
|
ldy #0
|
|
lda (SCRATCH_ZP1),y
|
|
sta (SCRATCH_ZPWORD1),y
|
|
iny
|
|
lda (SCRATCH_ZP1),y
|
|
sta (SCRATCH_ZPWORD1),y
|
|
iny
|
|
lda (SCRATCH_ZP1),y
|
|
sta (SCRATCH_ZPWORD1),y
|
|
iny
|
|
lda (SCRATCH_ZP1),y
|
|
sta (SCRATCH_ZPWORD1),y
|
|
iny
|
|
lda (SCRATCH_ZP1),y
|
|
sta (SCRATCH_ZPWORD1),y
|
|
ldy SCRATCH_ZPWORD1+1
|
|
rts
|
|
}
|
|
|
|
asm {
|
|
|
|
; ---- add 1 to the MFLT pointed to by X/Y. Clobbers A, X, Y
|
|
float_add_one
|
|
stx SCRATCH_ZP1
|
|
sty SCRATCH_ZP2
|
|
txa
|
|
jsr c64.MOVFM ; fac1 = float XY
|
|
lda #<c64.FL_FONE
|
|
ldy #>c64.FL_FONE
|
|
jsr c64.FADD ; fac1 += 1
|
|
ldx SCRATCH_ZP1
|
|
ldy SCRATCH_ZP2
|
|
jmp c64.FTOMEMXY ; float XY = fac1
|
|
|
|
; ---- subtract 1 from the MFLT pointed to by X/Y. Clobbers A, X, Y
|
|
float_sub_one
|
|
stx SCRATCH_ZP1
|
|
sty SCRATCH_ZP2
|
|
lda #<c64.FL_FONE
|
|
ldy #>c64.FL_FONE
|
|
jsr c64.MOVFM ; fac1 = 1
|
|
txa
|
|
ldy SCRATCH_ZP2
|
|
jsr c64.FSUB ; fac1 = float XY - 1
|
|
ldx SCRATCH_ZP1
|
|
ldy SCRATCH_ZP2
|
|
jmp c64.FTOMEMXY ; float XY = fac1
|
|
|
|
|
|
; ---- add MFLT pointed to by SCRATCH_ZPWORD1 to the MFLT pointed to by X/Y. Clobbers A, X, Y
|
|
float_add_SW1_to_XY
|
|
stx SCRATCH_ZP1
|
|
sty SCRATCH_ZP2
|
|
txa
|
|
jsr c64.MOVFM ; fac1 = float XY
|
|
lda SCRATCH_ZPWORD1
|
|
ldy SCRATCH_ZPWORD1+1
|
|
jsr c64.FADD ; fac1 += SCRATCH_ZPWORD1
|
|
ldx SCRATCH_ZP1
|
|
ldy SCRATCH_ZP2
|
|
jmp c64.FTOMEMXY ; float XY = fac1
|
|
|
|
|
|
; ---- subtract MFLT pointed to by SCRATCH_ZPWORD1 from the MFLT pointed to by X/Y. Clobbers A, X, Y
|
|
float_sub_SW1_from_XY
|
|
stx SCRATCH_ZP1
|
|
sty SCRATCH_ZP2
|
|
lda SCRATCH_ZPWORD1
|
|
ldy SCRATCH_ZPWORD1+1
|
|
jsr c64.MOVFM ; fac1 = SCRATCH_ZPWORD1
|
|
txa
|
|
ldy SCRATCH_ZP2
|
|
jsr c64.FSUB ; fac1 = float XY - SCRATCH_ZPWORD1
|
|
ldx SCRATCH_ZP1
|
|
ldy SCRATCH_ZP2
|
|
jmp c64.FTOMEMXY ; float XY = fac1
|
|
}
|
|
}
|