; Double buffer fast block move for standard 6502 CPU
; Transfer of an 160x160 pixel buffer into a 256x256 pixel display (monochrome)
; 60 Hz full frame time is about 16.6ms (60Hz)



Hires=$8000+512         ; pixel display 256x256 (8kb) start at line 16
Buffer=$6c00         ; double buffer size 5120 bytes, 3200 bytes used (160x160 pixel)

source=$13         ; Source address pointer
target=$15         ; Target address pointer

shift=5            ; shift byte offset of source data (variable)
offset=2         ; horizontal output display offset 2=16 pixel (basically fixed)

   .org $1000      ; transfer time 51950 cycles (almost 52msec) needed for 3200 bytes

   lda #>Buffer
   sta source+1
   
   lda #>Hires
   sta target+1
   
   ldx #19         ; 20*8 lines to transfer
   
L1:   lda #20+shift      ; variable source offset for horizonlal shifts to display output
   sta source
   lda #20+offset      ; Output at display + 16 pixel
   sta target
   
   jsr transfer
   inc source+1      ; next eight lines + 256 byte
   inc target+1
   dex
   bpl L1
   brk
   
   
transfer:         ; transfer group of 8 lines
   ldy #$00
   lda (source),y
   sta (target),y
   ldy #$20
   lda (source),y
   sta (target),y
   ldy #$40
   lda (source),y
   sta (target),y
   ldy #$60
   lda (source),y
   sta (target),y
   ldy #$80
   lda (source),y
   sta (target),y
   ldy #$A0
   lda (source),y
   sta (target),y
   ldy #$C0
   lda (source),y
   sta (target),y
   ldy #$E0
   lda (source),y
   sta (target),y
   dec source
   dec target      ; dec lower byte of address
   lda target
   cmp #offset-1
   bne transfer
   rts   

MU1      LDA (FROM),Y
         STA (TO),Y
         DEY
         BNE MU1

MU1
      LDA FROM1,Y
         STA TO1,Y
      LDA FROM2,Y
         STA TO2,Y
         DEY
         BNE MU1

; Double buffer fast block move for standard 6502 CPU
; Transfer of an 160x160 pixel buffer into a 256x256 pixel display
; 60 Hz full frame time is about 16.6ms (60Hz)



Hires=$8000+512         ; pixel display 256x256 (8kb) start at line 16
Buffer=$6c00         ; double buffer size 5120 bytes, 3200 bytes used (160x160 pixel)

Backup=$6B80
ZPtransfer=$80

shift=5            ; shift byte offset of source data (variable)
offset=2         ; horizontal output display offset 2=16 pixel (basically fixed)


   .org ZPtransfer
LZP:   ldy #19      ; 20 bytes (takes 49 bytes in ZeroPage)
S0:   lda Buffer,y   
T0:   sta Hires,y
S1:   lda Buffer,y   ; here Buffer + 5*256
T1:   sta Hires,y
S2:   lda Buffer,y   ; here Buffer + 10*256
T2:   sta Hires,y
S3:   lda Buffer,y   ; here Buffer + 15*256
T3:   sta Hires,y
   dey
   bpl S0
   inc S0+2
   inc S1+2
   inc S2+2
   inc S3+2
   inc T0+2
   inc T1+2
   inc T2+2
   inc T3+2
   dex
   bne LZP      ; Loop for 5x4
   rts   

   .org $1000      ; transfer time 37234 cycles (37.2msec) needed for 3200 bytes


   ldy #48         ; Backup ZeroPage
B1:   lda ZPtransfer,y
   sta Backup,y
   lda ZPCode,y      ; store ZeroPage code
   sta ZPtransfer,y
   dey
   bpl B1
   

   ldx #shift
   lda #offset
L1:   stx S0+1
   stx S1+1
   stx S2+1   
   stx S3+1
   
   sta T0+1
   sta T1+1
   sta T2+1   
   sta T3+1
   
   clc
   lda #>Buffer
   sta S0+2
   adc #5
   sta S1+2
   adc #5   
   sta S2+2
   adc #5   
   sta S3+2
   
   lda #>Hires
   sta T0+2
   adc #5
   sta T1+2
   adc #5   
   sta T2+2
   adc #5   
   sta T3+2
   
   ldx #5         ; 5*4*1 lines to transfer
   jsr LZP

   clc
   lda S0+1
   adc #$20      ; next line
   bcs Exit      ; we have reached end of 8 lines
   tax
   lda T0+1
   adc #$20      ; next line
   bcc L1
   
Exit:   ldy #48         ; Restore ZeroPage
B2:   lda Backup,y
   sta ZPtransfer,y
   dey
   bpl B2
      
   brk
   
   
ZPCode: .db $A0, $13, $B9, $00, $6C, $99, $00, $82, $B9, $00, $6C, $99
   .db $00, $82, $B9, $00, $6C, $99, $00, $82, $B9, $00, $6C, $99
   .db $00, $82, $88, $10, $E5, $E6, $84, $E6, $8A, $E6, $90, $E6
   .db $96, $E6, $87, $E6, $8D, $E6, $93, $E6, $99, $CA, $D0, $D0
   .db $60

ldy #19 ; Copy 200 pixels or 1 bit each
loop:
lda source,y ; 4 cycles
sta dest,y ; 5 cycles
lda source+20,y
sta dest+20,y
lda source+40,y
sta dest+20,y
... and so on
dey
bpl loop

fbCls:
        ldy     #SCREEN_WIDTHm1    ; Screen width minus 1
        lda     #' '
clearLoop:
        .repeat SCREEN_HEIGHT,i
        sta     frameBuffer + i * SCREEN_WIDTH,y
        .endrep
        dey
        bpl     clearLoop
        rts

ldx #<source
ldy #>source
jsr updateSource
...

updateSource:
  stx loop+1
  sty loop+2
  stx loop+7
  sty loop+8
... repeat for the 160 LDA's..
  rts