emailler/ip65/arithmetic.s

165 lines
2.7 KiB
ArmAsm

; helper routines for arithmetic on 32 bit numbers
.include "zeropage.inc"
.include "../inc/common.inc"
.bss
temp_ax: .res 2
.code
; no 16bit operand as can just use AX
.exportzp acc32 = ptr1 ; 32bit accumulater (pointer)
.exportzp op32 = ptr2 ; 32 bit operand (pointer)
.exportzp acc16 = acc32 ; 16bit accumulater (value, NOT pointer)
.export add_32_32
.export add_16_32
.export sub_16_16
.export cmp_32_32
.export cmp_16_16
.export mul_8_16
; compare 2 32bit numbers
; on exit, zero flag clear iff acc32==op32
cmp_32_32:
ldy #0
lda (op32),y
cmp (acc32),y
bne @exit
iny
lda (op32),y
cmp (acc32),y
bne @exit
iny
lda (op32),y
cmp (acc32),y
bne @exit
iny
lda (op32),y
cmp (acc32),y
@exit:
rts
; compare 2 16bit numbers
; on exit, zero flag clear iff acc16==AX
cmp_16_16:
cmp acc16
bne @exit
txa
cmp acc16+1
@exit:
rts
; subtract 2 16 bit numbers
; acc16=acc16-AX
sub_16_16:
stax temp_ax
sec
lda acc16
sbc temp_ax
sta acc16
lda acc16+1
sbc temp_ax+1
sta acc16+1
rts
; add a 32bit operand to the 32 bit accumulater
; acc32=acc32+op32
add_32_32:
clc
ldy #0
lda (op32),y
adc (acc32),y
sta (acc32),y
iny
lda (op32),y
adc (acc32),y
sta (acc32),y
iny
lda (op32),y
adc (acc32),y
sta (acc32),y
iny
lda (op32),y
adc (acc32),y
sta (acc32),y
rts
; add a 16bit operand to the 32 bit accumulater
; acc32=acc32+AX
add_16_32:
clc
ldy #0
adc (acc32),y
sta (acc32),y
iny
txa
adc (acc32),y
sta (acc32),y
iny
lda #0
adc (acc32),y
sta (acc32),y
iny
lda #0
adc (acc32),y
sta (acc32),y
rts
; multiply a 16 bit number by an 8 bit number
; acc16=acc16*a
mul_8_16:
tax
beq @operand_is_zero
lda acc16
sta temp_ax
lda acc16+1
sta temp_ax+1
@addition_loop:
dex
beq @done
clc
lda acc16
adc temp_ax
sta acc16
lda acc16+1
adc temp_ax+1
sta acc16+1
jmp @addition_loop
@done:
rts
@operand_is_zero:
sta acc16
sta acc16+1
rts
; -- LICENSE FOR arithmetic.s --
; The contents of this file are subject to the Mozilla Public License
; Version 1.1 (the "License"); you may not use this file except in
; compliance with the License. You may obtain a copy of the License at
; http://www.mozilla.org/MPL/
;
; Software distributed under the License is distributed on an "AS IS"
; basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the
; License for the specific language governing rights and limitations
; under the License.
;
; The Original Code is ip65.
;
; The Initial Developer of the Original Code is Jonno Downes,
; jonno@jamtronix.com.
; Portions created by the Initial Developer are Copyright (C) 2009
; Jonno Downes. All Rights Reserved.
; -- LICENSE END --