mirror of
https://github.com/deater/dos33fsprogs.git
synced 2024-10-24 23:25:28 +00:00
212 lines
2.3 KiB
ArmAsm
212 lines
2.3 KiB
ArmAsm
|
; Bresenham Lines
|
||
|
|
||
|
; by Vince `deater` Weaver <vince@deater.net>
|
||
|
|
||
|
; based on code from https://gist.github.com/petrihakkinen/
|
||
|
|
||
|
; note this code can break if X>32 or Y>32
|
||
|
; notice this if you try to plot 0,36 to 36,35
|
||
|
|
||
|
|
||
|
|
||
|
.include "zp.inc"
|
||
|
.include "hardware.inc"
|
||
|
|
||
|
; 171 -- initial
|
||
|
; 167 -- inline init
|
||
|
|
||
|
B_X1 = $F0
|
||
|
B_Y1 = $F1
|
||
|
B_X2 = $F2
|
||
|
B_Y2 = $F3
|
||
|
B_DX = $F4
|
||
|
B_DY = $F5
|
||
|
B_SX = $F6
|
||
|
B_SY = $F7
|
||
|
B_ERR = $F8
|
||
|
COUNT = $F9
|
||
|
|
||
|
lines:
|
||
|
|
||
|
jsr SETGR ; set lo-res 40x40 mode
|
||
|
; A=$D0 afterward
|
||
|
|
||
|
|
||
|
lda #0
|
||
|
sta COUNT
|
||
|
lines_loop:
|
||
|
|
||
|
jsr NEXTCOL
|
||
|
|
||
|
lda #0
|
||
|
sta B_X1
|
||
|
; lda #36
|
||
|
lda #35
|
||
|
sta B_Y2
|
||
|
|
||
|
lda COUNT
|
||
|
cmp #10
|
||
|
end:
|
||
|
beq end
|
||
|
|
||
|
asl
|
||
|
asl
|
||
|
sta B_Y1
|
||
|
sta B_X2
|
||
|
|
||
|
jsr draw_line
|
||
|
|
||
|
inc COUNT
|
||
|
|
||
|
jmp lines_loop
|
||
|
|
||
|
|
||
|
|
||
|
;============================
|
||
|
; draw line
|
||
|
; from x1,y1 to x2,y2
|
||
|
;============================
|
||
|
draw_line:
|
||
|
|
||
|
; from wikipedia
|
||
|
|
||
|
; dx = abs(x2 - x1)
|
||
|
; sx = x1 < x2 ? 1 : -1
|
||
|
|
||
|
; dy = -abs(y2 - y1)
|
||
|
; sy = y1 < y2 ? 1 : -1
|
||
|
|
||
|
; err = dx+dy
|
||
|
|
||
|
; dx=dx*2
|
||
|
; dy=dy*2
|
||
|
|
||
|
init_bresenham:
|
||
|
|
||
|
; dy = abs(y2-y1)
|
||
|
; sy = y1 < y2 ? 1 : -1
|
||
|
|
||
|
ldx #$ff ; X = -1
|
||
|
lda B_Y1
|
||
|
sec
|
||
|
sbc B_Y2 ; A = y1 - y2
|
||
|
|
||
|
bpl yskip
|
||
|
inx
|
||
|
inx ; X = 1
|
||
|
|
||
|
jsr neg ; A = y2 - y1
|
||
|
yskip:
|
||
|
sta B_DY
|
||
|
stx B_SY
|
||
|
|
||
|
; dx = abs(x2-x1)
|
||
|
; sx = x1<x2 ? 1 : -1
|
||
|
|
||
|
ldx #$ff ; X = -1
|
||
|
lda B_X1
|
||
|
sec
|
||
|
sbc B_X2 ; A = x1 - x2
|
||
|
|
||
|
bpl xskip
|
||
|
inx
|
||
|
inx ; X = 1
|
||
|
jsr neg ; A = x2 - x1
|
||
|
xskip:
|
||
|
sta B_DX
|
||
|
stx B_SX
|
||
|
|
||
|
|
||
|
; err = dx > dy ? dx : -dy
|
||
|
; lda B_DX
|
||
|
|
||
|
cmp B_DY ; dx - dy > 0
|
||
|
beq noskiperr
|
||
|
bpl skiperr
|
||
|
noskiperr:
|
||
|
lda B_DY
|
||
|
jsr neg
|
||
|
skiperr:
|
||
|
sta B_ERR
|
||
|
|
||
|
; dx = dx * 2
|
||
|
; dy = dy * 2
|
||
|
asl B_DX
|
||
|
asl B_DY
|
||
|
|
||
|
line_loop:
|
||
|
|
||
|
ldy B_X1
|
||
|
lda B_Y1
|
||
|
|
||
|
jsr PLOT ; PLOT AT Y,A
|
||
|
|
||
|
ldy B_X1
|
||
|
cpy B_X2
|
||
|
bne line_no_end
|
||
|
|
||
|
lda B_Y1
|
||
|
cmp B_Y2
|
||
|
beq done_line
|
||
|
line_no_end:
|
||
|
|
||
|
jsr step_bresenham
|
||
|
|
||
|
|
||
|
jmp line_loop
|
||
|
|
||
|
done_line:
|
||
|
rts
|
||
|
|
||
|
;========================
|
||
|
; step
|
||
|
;========================
|
||
|
|
||
|
step_bresenham:
|
||
|
; err2 = err
|
||
|
lda B_ERR
|
||
|
pha ; push err2
|
||
|
|
||
|
; if err2 > -dx:
|
||
|
; err = err - dy
|
||
|
; x = x + sx
|
||
|
clc
|
||
|
adc B_DX ; skip if err2 + dx <= 0
|
||
|
bmi skip_x
|
||
|
beq skip_x
|
||
|
lda B_ERR
|
||
|
sec
|
||
|
sbc B_DY
|
||
|
sta B_ERR
|
||
|
lda B_X1
|
||
|
clc
|
||
|
adc B_SX
|
||
|
sta B_X1
|
||
|
|
||
|
skip_x:
|
||
|
; if err2 < dy:
|
||
|
; err = err + dx
|
||
|
; y = y + sy
|
||
|
pla ; pop err2
|
||
|
cmp B_DY ; skip if err2 - dy >= 0
|
||
|
bpl skip_y
|
||
|
lda B_ERR
|
||
|
clc
|
||
|
adc B_DX
|
||
|
sta B_ERR
|
||
|
lda B_Y1
|
||
|
clc
|
||
|
adc B_SY
|
||
|
sta B_Y1
|
||
|
|
||
|
skip_y:
|
||
|
rts
|
||
|
|
||
|
|
||
|
|
||
|
neg:
|
||
|
eor #$ff
|
||
|
clc
|
||
|
adc #1
|
||
|
rts
|