avr: split code in multiple files and routines.

avr/modules/flash/hdl_flash_data.asm

@@ -0,0 +1,62 @@
+; ***************************************************************************
+; copyright   : (C) 2023 by Martin Preuss
+; email       : martin@libchipcard.de
+;
+; ***************************************************************************
+; * This file is part of the project "AqHome".                              *
+; * Please see toplevel file COPYING of that project for license details.   *
+; ***************************************************************************
+
+
+
+; ***************************************************************************
+; code
+
+
+.cseg
+
+
+
+; ---------------------------------------------------------------------------
+; Handle FLASH DATA packet.
+;
+; IN:
+; - X  : buffer containing the message
+; OUT:
+; - CFLAG: set if message is for us, cleared otherwise
+; REGS: R0, R1, R15, R16, R17, R18, R19, R20, R21, R24, R25, X, Z
+
+flashHandleFlashData:
+  adiw xh:xl, FLASH_MSG_OFFS_MSGLEN
+  ld r18, X                           ; length (subtract 6
+  cpi r18, 6                          ; cmd(1), src(1), addr(4)
+  brcs flashHandleFlashData_badData
+  subi r18, 6                         ; remaining length
+  adiw xh:xl, FLASH_PACKET_DATA_OFFS_ADDR-FLASH_MSG_OFFS_MSGLEN
+  ld zl, X+                           ; address (low)
+  ld zh, X+                           ; address (high)
+  adiw xh:xl, 2                       ; ignore high bytes, points to first data byte now
+
+;  rcall Flash_StartPage               ; (R0, R1, R16, R20, R24, R25)
+  push zl
+    push zh
+flashHandleFlashData_loop:
+        ld r0, X+
+        ld r1, X+
+        rcall Flash_WriteIntoPage     ; (R15, R16, Z+)
+        subi r18, 2
+      brne flashHandleFlashData_loop
+    pop zh
+  pop zl
+  rcall Flash_FinishPage              ; (R15, R16, R20)
+  clr r16
+  rjmp flashHandleFlashData_sendResponse
+flashHandleFlashData_badData:
+  ldi r16, FLASH_ERROR_MSGERROR
+flashHandleFlashData_sendResponse:
+  rcall flashSendFlashResponse        ; (R15, R16, R17, R18, R19, R20, R21, R22, X)
+  sec
+  ret
+
+
+