flash: use 16-bit counters.

2025-06-01 19:22:04 +02:00
parent bb14dd4c22
commit 1e5de0da23
2 changed files with 26 additions and 17 deletions
--- a/avr/modules/flash/flash1pmega.asm
+++ b/avr/modules/flash/flash1pmega.asm
@@ -42,13 +42,14 @@ flash1pMegaWritePage:
  ldi xl, LOW(flashPageBuffer)
  ldi xh, HIGH(flashPageBuffer)
  ldi r24, LOW(PAGESIZE)
+  ldi r25, HIGH(PAGESIZE)
 flash1pMegaWritePages_loop:
    ld r0, X+                               ; read source data from buffer (low)
    ld r1, X+                               ; read source data from buffer (high)
    ldi r20, (1<<SPMEN)                     ; enable next SPM, write R1:R0 into temp page buffer
    rcall flashDoSpm                        ; (R16)
    adiw zh:zl, 2
-    dec r24
+    sbiw r25:r24, 1
  brne flash1pMegaWritePages_loop

  subi zl, LOW(PAGESIZE*2)                  ; point back to begin of page