mirror of https://github.com/rigreco/UniDisk.git
160 lines
2.7 KiB
ArmAsm
160 lines
2.7 KiB
ArmAsm
* @com.wudsn.ide.asm.hardware=APPLE2
|
|
************************************
|
|
* BASIC TO FAC TO FP1 *
|
|
* X=NUMBER *
|
|
* CALL 768,X *
|
|
************************************
|
|
org $300
|
|
|
|
CHKCOM equ $DEBE
|
|
FRMNUM equ $DD67
|
|
PTRGET equ $DFE3
|
|
MOVMF equ $EB2B
|
|
MOVFM equ $EAF9
|
|
|
|
** Woz FP Accumulator 4 Byte + 1 Byte Extra + 1 Byte SIGN**
|
|
FP1 equ $FA ;Translate F8 --> FA
|
|
E equ $FE ;Translate FC --> FE
|
|
SIGN equ $EB
|
|
|
|
FP2 equ $EC
|
|
|
|
** Applesoft FP Accumulator 5 Byte + 1 Byte Sign **
|
|
FAC equ $9D
|
|
|
|
|
|
***************************
|
|
|
|
ENTRY1 jsr CHKCOM
|
|
jsr FRMNUM ;VARIABLE X ->FAC (6 Byte Unpacked)
|
|
|
|
** FPC to FP1 conversion **
|
|
|
|
lda FAC
|
|
dec A ; dec the EXP
|
|
sta FP1
|
|
|
|
lda FAC+5
|
|
bmi NEG ; chk the Hi bit of 1 byte Mantissa
|
|
|
|
POS clc ; Hi bit 0 for negative
|
|
lda FAC+5
|
|
|
|
ora #$80 ; Set Hi Bit 1 byte Mantissa (change Sign only if is positive)
|
|
ror ; Didide for 2^1
|
|
|
|
sta FP1+1
|
|
|
|
jmp CONT
|
|
|
|
NEG clc ; Hi bit 1 for positive
|
|
lda FAC+5
|
|
|
|
ror ; Didide for 2^1
|
|
|
|
eor #$FF ; One's complement, NOT
|
|
clc
|
|
adc #01 ; Two's complement, +1
|
|
|
|
sta FP1+1
|
|
|
|
CONT lda FAC+2
|
|
ror
|
|
sta FP1+2
|
|
|
|
lda FAC+3
|
|
ror
|
|
sta FP1+3
|
|
|
|
lda FAC+4
|
|
ror
|
|
sta E
|
|
|
|
;brk
|
|
rts
|
|
************************************
|
|
* FP1 Calc *
|
|
* CALL 821 *
|
|
************************************
|
|
|
|
** Copy FP1 to FP2 **
|
|
|
|
ENTRY2 lda FP1
|
|
sta FP2 ;X1-->X2
|
|
|
|
lda FP1+1 ;M1-->M2
|
|
sta FP2+1
|
|
lda FP1+2
|
|
sta FP2+2
|
|
lda FP1+3
|
|
sta FP2+3
|
|
*
|
|
** Y=X*X **
|
|
*
|
|
jsr $8067 ;FMUL
|
|
|
|
rts
|
|
************************************
|
|
* FP1 TO FAC TO BASIC *
|
|
* CALL 841,Y *
|
|
* PRINT Y *
|
|
************************************
|
|
|
|
*
|
|
** FP1 to MEM to FAC conversion **
|
|
*
|
|
ENTRY3 lda FP1 ; X1 1 Byte --> 9D FAC
|
|
inc A ; 2^(FP1+1) inc EXP
|
|
sta FAC
|
|
|
|
lda FP1+1
|
|
bmi NEG2 ; chk the Hi bit of 1 byte Mantissa
|
|
|
|
|
|
POS2 clc
|
|
lda FP1+1 ; M1 Hi 2 Byte --> 9E FAC
|
|
rol ; Multiply for 2^1
|
|
|
|
ora #$80 ; Set Hi Bit 1 byte Mantissa (change Sign only if is positive)
|
|
sta FAC+1 ; To 6^ Byte of FAC Unpacked
|
|
|
|
;sta FAC+5 ; To 1^ Byte Mantissa of FAC UnPacked
|
|
jmp CONT2
|
|
|
|
NEG2 lda FP1+1
|
|
|
|
sec
|
|
sbc #01 ; One's complement inv -1
|
|
eor #$FF ; Two's complement inv NOT
|
|
|
|
rol ; Multiply for 2^1
|
|
|
|
sta FAC+1 ; To 1^ Byte Mantissa of FAC Packed
|
|
sta FAC+5 ; To 6^ Byte of FAC Unpacked
|
|
|
|
|
|
CONT2 lda FP1+2 ; M1 3 Byte --> 9F FAC
|
|
rol
|
|
sta FAC+2
|
|
|
|
lda FP1+3 ; M1 Lo 4 Byte --> A0 FAC
|
|
rol
|
|
sta FAC+3
|
|
|
|
lda E ; Extra 5 Byte --> A1 FAC
|
|
rol
|
|
sta FAC+4
|
|
|
|
;brk
|
|
***************************
|
|
*
|
|
;ldy #$03 ;Hi Byte MEM
|
|
;lda #$80 ;Lo Byte MEM
|
|
*
|
|
jsr CHKCOM
|
|
jsr PTRGET
|
|
tax
|
|
jsr MOVMF ;FAC->VARIABLE Y (5 Bytes Packed)
|
|
|
|
;brk
|
|
rts |