From ed21f4bbfce6f9b3ff9a266b2345f10fe6a37904 Mon Sep 17 00:00:00 2001 From: Martin Preuss Date: Sat, 7 Sep 2024 14:58:37 +0200 Subject: [PATCH] avr: fixed a bug in message creation. --- avr/modules/flash/flash_rsp.asm | 17 ++++++++--------- 1 file changed, 8 insertions(+), 9 deletions(-) diff --git a/avr/modules/flash/flash_rsp.asm b/avr/modules/flash/flash_rsp.asm index c7cfa99..49b6936 100644 --- a/avr/modules/flash/flash_rsp.asm +++ b/avr/modules/flash/flash_rsp.asm @@ -29,7 +29,6 @@ flashSendFlashResponse: ; send flash ready message ldi xl, LOW(flashSendBuffer) ldi xh, HIGH(flashSendBuffer) - clr r16 rcall flashWriteFlashRsp ; (R16, R17, R18, R19, R20) rjmp flashSendPacketUntilSuccess ; (R15, R16, R17, R21, R22, X) @@ -48,17 +47,17 @@ flashSendFlashResponse: flashWriteFlashRsp: clr r18 - st X+, r18 ; dest address (unused) - ldi r18, 3 ; msg code+src address+one payload byte - st X+, r18 ; msg len + st X+, r18 ; dest address (unused) + ldi r18, 3 ; msg code+src address+one payload byte + st X+, r18 ; msg len ldi r17, CPRO_CMD_FLASH_RSP - st X+, r17 ; msg code + st X+, r17 ; msg code clr r17 - st X+, r17 ; src address (not used) - st X, r16 ; payload byte - sbiw xh:xl, 4 - rcall com2CalcAndAddChecksumByte ; (R16, R17, R18, R19, R20, X) + st X+, r17 ; src address (not used) + st X+, r16 ; payload byte sbiw xh:xl, 5 + rcall com2CalcAndAddChecksumByte ; (R16, R17, R18, R19, R20, X) + sbiw xh:xl, 6 ret