41 lines
1.6 KiB
NASM
41 lines
1.6 KiB
NASM
; ***************************************************************************
|
|
; copyright : (C) 2025 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. *
|
|
; ***************************************************************************
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; @routine NETMSG_Device_Write
|
|
;
|
|
; @param Y pointer to device to write msg for
|
|
; @param X pointer to buffer to write to
|
|
; @clobbers R16, R18 (R17, R19, R20, R21, Z)
|
|
|
|
NETMSG_Device_Write:
|
|
ldi r16, 0xff
|
|
st X+, r16 ; dest address
|
|
ldi r16, 18 ; msg code+src address+12 payload bytes
|
|
st X+, r16 ; msg len
|
|
ldi r16, NETMSG_CMD_DEVICE
|
|
st X+, r16 ; msg code
|
|
ldd r16, Y+NET_IFACE_OFFS_ADDRESS
|
|
st X+, r16 ; src address
|
|
rcall NETMSG_Common_AddUidToBuffer ; (R16, R18, R19, R20, R21)
|
|
ldi zh, HIGH(devInfoBlock*2) ; 6-17: devInfoBlock
|
|
ldi zl, LOW(devInfoBlock*2)
|
|
ldi r18, 12
|
|
rcall Utils_CopyFromFlash ; (R17, R18, X, Z)
|
|
sbiw xh:xl, 20 ; go back to beginning of message (1 byte dst addr, 1 byte length, 18 bytes payload)
|
|
rcall NETMSG_CalcAndAddChecksumByte ; (R16, R17, R18, R19, R20, X)
|
|
sbiw xh:xl, 21 ; go back to beginning of message (1 byte dst addr, 1 byte length, 18 bytes payload, 1 byte crc)
|
|
ret
|
|
; @end
|
|
|
|
|
|
|