martin/aqhomecontrol
Public Access
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

avr: fixed a bug in message creation.

Browse Source
This commit is contained in:
Martin Preuss
2024-09-07 14:58:37 +02:00
parent d99787b787
commit ed21f4bbfc
1 changed files with 8 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files

17
avr/modules/flash/flash_rsp.asm
View File

@@ -29,7 +29,6 @@ flashSendFlashResponse:
; send flash ready message ; send flash ready message
ldi xl, LOW(flashSendBuffer) ldi xl, LOW(flashSendBuffer)
ldi xh, HIGH(flashSendBuffer) ldi xh, HIGH(flashSendBuffer)
clr r16
rcall flashWriteFlashRsp ; (R16, R17, R18, R19, R20) rcall flashWriteFlashRsp ; (R16, R17, R18, R19, R20)
rjmp flashSendPacketUntilSuccess ; (R15, R16, R17, R21, R22, X) rjmp flashSendPacketUntilSuccess ; (R15, R16, R17, R21, R22, X)
@@ -48,17 +47,17 @@ flashSendFlashResponse:
flashWriteFlashRsp: flashWriteFlashRsp:
clr r18 clr r18
st X+, r18 ; dest address (unused) st X+, r18 ; dest address (unused)
ldi r18, 3 ; msg code+src address+one payload byte ldi r18, 3 ; msg code+src address+one payload byte
st X+, r18 ; msg len st X+, r18 ; msg len
ldi r17, CPRO_CMD_FLASH_RSP ldi r17, CPRO_CMD_FLASH_RSP
st X+, r17 ; msg code st X+, r17 ; msg code
clr r17 clr r17
st X+, r17 ; src address (not used) st X+, r17 ; src address (not used)
st X, r16 ; payload byte st X+, r16 ; payload byte
sbiw xh:xl, 4
rcall com2CalcAndAddChecksumByte ; (R16, R17, R18, R19, R20, X)
sbiw xh:xl, 5 sbiw xh:xl, 5
rcall com2CalcAndAddChecksumByte ; (R16, R17, R18, R19, R20, X)
sbiw xh:xl, 6
ret ret