started working on new n23 code.
This commit is contained in:
Martin Preuss
361
avr/devices/n23/main/network.asm
Normal file
361
avr/devices/n23/main/network.asm
Normal file
@@ -0,0 +1,361 @@
|
||||
; ***************************************************************************
|
||||
; 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. *
|
||||
; ***************************************************************************
|
||||
|
||||
|
||||
|
||||
; ***************************************************************************
|
||||
; defines
|
||||
|
||||
.equ APP_NETWORK_STATE_INITIALWAIT = 0 ; initially wait
|
||||
.equ APP_NETWORK_STATE_NEEDADDRESS = 1 ; wait for range msgs after sending "NEEDADDRESS"
|
||||
.equ APP_NETWORK_STATE_CLAIMADDRESS1 = 2 ; wait for "DENYADDRESS"
|
||||
.equ APP_NETWORK_STATE_CLAIMADDRESS2 = 3 ; wait for "DENYADDRESS"
|
||||
.equ APP_NETWORK_STATE_CLAIMADDRESS3 = 4 ; wait for "DENYADDRESS"
|
||||
.equ APP_NETWORK_STATE_HAVEADDRESS1 = 5 ; just notify (and handle "DENYADDRESS")
|
||||
.equ APP_NETWORK_STATE_HAVEADDRESS2 = 6 ; just notify (and handle "DENYADDRESS")
|
||||
.equ APP_NETWORK_STATE_UP = 7
|
||||
.equ APP_NETWORK_STATE_COUNT = 8
|
||||
|
||||
.equ APP_NETWORK_TIMER_100MS = 50
|
||||
|
||||
|
||||
.equ APP_NETWORK_ADDRESS_RANGE_BEGIN = 1
|
||||
.equ APP_NETWORK_ADDRESS_RANGE_END = 192
|
||||
|
||||
|
||||
|
||||
|
||||
; ***************************************************************************
|
||||
; data
|
||||
|
||||
.dseg
|
||||
|
||||
|
||||
|
||||
|
||||
; ***************************************************************************
|
||||
; code
|
||||
|
||||
.cseg
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine AppNetwork_Init @global
|
||||
;
|
||||
|
||||
AppNetwork_Init:
|
||||
rcall appNetworkResetState
|
||||
sec
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine AppNetwork_Fini @global
|
||||
;
|
||||
|
||||
AppNetwork_Fini:
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine AppNetwork_Every100ms @global
|
||||
;
|
||||
|
||||
AppNetwork_Every100ms:
|
||||
ldd r16, Y+NET_IFACE_OFFS_STATETIMER
|
||||
tst r16
|
||||
brne AppNetwork_Every100ms_decAndJump
|
||||
ret
|
||||
AppNetwork_Every100ms_decAndJump:
|
||||
dec r16
|
||||
std Y+NET_IFACE_OFFS_STATETIMER, r16
|
||||
brne AppNetwork_Every100ms_end
|
||||
ldd r16, Y+NET_IFACE_OFFS_STATUS
|
||||
cpi r16, APP_NETWORK_STATE_COUNT
|
||||
brcs AppNetwork_Every100ms_jump
|
||||
AppNetwork_Every100ms_end:
|
||||
ret
|
||||
AppNetwork_Every100ms_jump:
|
||||
ldi zl, LOW(appNetworkTimerTable)
|
||||
ldi zh, HIGH(appNetworkTimerTable)
|
||||
add zl, r16
|
||||
adc zh, r16
|
||||
sub zh, r16
|
||||
ijmp
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine AppNetwork_HandleMsg @global
|
||||
;
|
||||
; @param X pointer to received message
|
||||
|
||||
AppNetwork_HandleMsg:
|
||||
adiw xh:xl, NETMSG_OFFS_CMD
|
||||
ld r16, X
|
||||
sbiw xh:xl, NETMSG_OFFS_CMD
|
||||
cpi r16, NETMSG_CMD_HAVE_ADDRESS
|
||||
brcs AppNetwork_HandleMsg_clcRet ; lower than "HAVE_ADDR"
|
||||
cpi r16, NETMSG_CMD_ADDRESS_RANGE
|
||||
breq AppNetwork_HandleMsg_handleRangeMsg
|
||||
brcc AppNetwork_HandleMsg_clcRet ; higher or equal to "ADDR_RANGE"
|
||||
rjmp AppNetwork_HandleMsg_handleAddrMsg
|
||||
AppNetwork_HandleMsg_handleRangeMsg:
|
||||
; TODO
|
||||
rjmp AppNetwork_HandleMsg_clcRet
|
||||
|
||||
AppNetwork_HandleMsg_handleAddrMsg:
|
||||
rcall NETMSG_Address_Read ; (R18, R19)
|
||||
mov r16, r18
|
||||
subi r16, NETMSG_CMD_HAVE_ADDRESS
|
||||
ldi zl, LOW(appNetworkMsgTable)
|
||||
ldi zh, HIGH(appNetworkMsgTable)
|
||||
add zl, r16
|
||||
adc zh, r16
|
||||
sub zh, r16
|
||||
ijmp
|
||||
|
||||
AppNetwork_HandleMsg_clcRet:
|
||||
clc
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
appNetworkTimerTable:
|
||||
rjmp appNetworkHandleStateInitialWait
|
||||
rjmp appNetworkHandleStateNeedAddress
|
||||
rjmp appNetworkHandleStateClaimAddress1
|
||||
rjmp appNetworkHandleStateClaimAddress2
|
||||
rjmp appNetworkHandleStateClaimAddress3
|
||||
rjmp appNetworkHandleStateHaveAddress1
|
||||
rjmp appNetworkHandleStateHaveAddress2
|
||||
rjmp appNetworkHandleStateUp
|
||||
|
||||
|
||||
appNetworkHandleStateInitialWait:
|
||||
ldi r18, NETMSG_CMD_NEED_ADDRESS
|
||||
rjmp appNetworkSendMsgNextState
|
||||
|
||||
|
||||
appNetworkHandleStateNeedAddress:
|
||||
ldi r18, NETMSG_CMD_CLAIM_ADDRESS
|
||||
rjmp appNetworkSendMsgNextState
|
||||
|
||||
|
||||
appNetworkHandleStateClaimAddress1:
|
||||
ldi r18, NETMSG_CMD_CLAIM_ADDRESS
|
||||
rjmp appNetworkSendMsgNextState
|
||||
|
||||
|
||||
appNetworkHandleStateClaimAddress2:
|
||||
ldi r18, NETMSG_CMD_CLAIM_ADDRESS
|
||||
rjmp appNetworkSendMsgNextState
|
||||
|
||||
|
||||
appNetworkHandleStateClaimAddress3:
|
||||
ldi r18, NETMSG_CMD_HAVE_ADDRESS
|
||||
rjmp appNetworkSendMsgNextState
|
||||
|
||||
|
||||
appNetworkHandleStateHaveAddress1:
|
||||
ldi r18, NETMSG_CMD_HAVE_ADDRESS
|
||||
rjmp appNetworkSendMsgNextState
|
||||
|
||||
|
||||
appNetworkHandleStateHaveAddress2:
|
||||
ldi r16, APP_NETWORK_STATE_UP
|
||||
std Y+NET_IFACE_OFFS_STATUS, r16
|
||||
ldd r16, Y+NET_IFACE_OFFS_RANGE_BEGIN ; set interface address
|
||||
std Y+NET_IFACE_OFFS_ADDRESS, r16
|
||||
ret
|
||||
|
||||
|
||||
appNetworkHandleStateUp:
|
||||
ldi r16, 200 ; come again after 20s (nothing to do for now, maybe add some cleanup later)
|
||||
std Y+NET_IFACE_OFFS_STATETIMER, r16
|
||||
ret
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine appNetworkSendMsgNextState
|
||||
;
|
||||
; @param R18 msg type to send
|
||||
; @clobbers R16, R19 (R17, R18, R20, R21, X)
|
||||
|
||||
appNetworkSendMsgNextState:
|
||||
ldd r19, NET_IFACE_OFFS_RANGE_BEGIN
|
||||
rcall appNetworkSendAddrMsg ; (R16, R17, R18, R19, R20, R21, X)
|
||||
brcc appNetworkSendMsgNextState_end
|
||||
ldd r16, Y+NET_IFACE_OFFS_STATUS
|
||||
inc r16
|
||||
std Y+NET_IFACE_OFFS_STATUS, r16
|
||||
ldi r16, APP_NETWORK_TIMER_100MS
|
||||
std Y+NET_IFACE_OFFS_STATETIMER, r16
|
||||
appNetworkSendMsgNextState_end:
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
appNetworkMsgTable:
|
||||
rjmp appNetworkHandleMsgNeedAddr
|
||||
rjmp appNetworkHandleMsgHaveAddr
|
||||
rjmp appNetworkHandleMsgClaimAddr
|
||||
rjmp appNetworkHandleMsgDenyAddr
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine appNetworkHandleMsgNeedAddr
|
||||
;
|
||||
; @param R18 command
|
||||
; @param R19 address to send
|
||||
|
||||
appNetworkHandleMsgNeedAddr:
|
||||
clc
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine appNetworkHandleMsgHaveAddr
|
||||
;
|
||||
; @param R18 command
|
||||
; @param R19 address to send
|
||||
|
||||
appNetworkHandleMsgHaveAddr:
|
||||
clc
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine appNetworkHandleMsgClaimAddr
|
||||
;
|
||||
; @param R18 command
|
||||
; @param R19 address from CLAIM_ADDRESS message
|
||||
|
||||
appNetworkHandleMsgClaimAddr:
|
||||
ldd r16, Y+NET_IFACE_OFFS_ADDRESS
|
||||
cp r19, r16
|
||||
brne appNetworkHandleMsgClaimAddr_end ; not our address
|
||||
ldd r16, Y+NET_IFACE_OFFS_STATUS
|
||||
cpi r16, APP_NETWORK_STATE_UP ; up?
|
||||
brne appNetworkHandleMsgClaimAddr_end ; nope, ignore
|
||||
; network is up, someone claimed our address, deny it
|
||||
ldi r18, NETMSG_CMD_DENY_ADDRESS ; deny our addr
|
||||
ldd r19, Y+NET_IFACE_OFFS_ADDRESS
|
||||
rjmp appNetworkSendAddrMsg
|
||||
appNetworkHandleMsgClaimAddr_end:
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine appNetworkHandleMsgDenyAddr
|
||||
;
|
||||
; @param R18 command
|
||||
; @param R19 address from DENY_ADDR message
|
||||
|
||||
appNetworkHandleMsgDenyAddr:
|
||||
; check state
|
||||
ldd r16, Y+NET_IFACE_OFFS_STATUS
|
||||
cpi r16, APP_NETWORK_STATE_UP
|
||||
breq appNetworkHandleMsgDenyAddr_end ; ignore (our network stack is up)
|
||||
; still setting up address, check whether the last one is denied now
|
||||
ldd r16, Y+NET_IFACE_OFFS_RANGE_BEGIN
|
||||
cp r19, r16 ; our claimed address?
|
||||
brne appNetworkHandleMsgDenyAddr_end ; nope, jump
|
||||
; try next address (if any left)
|
||||
ldd r17, Y+NET_IFACE_OFFS_RANGE_END
|
||||
inc r16
|
||||
cp r16, r17
|
||||
brcs appNetworkHandleMsgDenyAddr_claimNext
|
||||
; out of addresses, start completely new after some waiting time
|
||||
rcall appNetworkResetState
|
||||
ldi r16, 200 ; wait for 20s before trying whole process again
|
||||
std Y+NET_IFACE_OFFS_STATETIMER, r16
|
||||
rjmp appNetworkHandleMsgClaimAddr_end
|
||||
appNetworkHandleMsgDenyAddr_claimNext:
|
||||
; send CLAIM_ADDR for next address (new state: APP_NETWORK_STATE_NEEDADDRESS+1)
|
||||
std Y+NET_IFACE_OFFS_RANGE_BEGIN, r16
|
||||
ldi r16, APP_NETWORK_STATE_NEEDADDRESS
|
||||
std Y+NET_IFACE_OFFS_STATUS, r16
|
||||
ldi r18, NETMSG_CMD_CLAIM_ADDRESS
|
||||
rjmp appNetworkSendMsgNextState
|
||||
appNetworkHandleMsgClaimAddr_end:
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine appNetworkSendAddrMsg
|
||||
;
|
||||
; @param Y pointer to device to write msg for
|
||||
; @param R18 command
|
||||
; @param R19 address to send
|
||||
; @clobbers R16 (R17, R18, R19, R20, R21, X)
|
||||
|
||||
appNetworkSendAddrMsg:
|
||||
rcall NET_Buffer_Alloc ; (R16, R17, X)
|
||||
brcc appNetworkSendAddrMsg_end
|
||||
adiw xh:xl, 1
|
||||
push r16
|
||||
rcall NETMSG_Address_Write ; (R16, R17, R18, R19, R20, R21)
|
||||
pop r16
|
||||
sbiw xh:xl, 1
|
||||
rcall NET_Interface_AddOutgoingMsgNum ; (R17, R18, X)
|
||||
brcs appNetworkSendAddrMsg_end
|
||||
rcall NET_Buffer_ReleaseByNum ; (R16, X)
|
||||
clc
|
||||
appNetworkSendAddrMsg_end:
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine appNetworkResetState
|
||||
;
|
||||
; @param Y pointer to device to write msg for
|
||||
; @clobbers R16
|
||||
|
||||
appNetworkResetState:
|
||||
ldi r16, APP_NETWORK_STATE_INITIALWAIT
|
||||
std Y+NET_IFACE_OFFS_STATUS, r16
|
||||
ldi r16, APP_NETWORK_TIMER_100MS
|
||||
std Y+NET_IFACE_OFFS_STATETIMER, r16
|
||||
ldi r16, APP_NETWORK_ADDRESS_RANGE_BEGIN
|
||||
std Y+NET_IFACE_OFFS_RANGE_BEGIN, r16
|
||||
ldi r16, APP_NETWORK_ADDRESS_RANGE_END ; last possible address+1
|
||||
std Y+NET_IFACE_OFFS_RANGE_END, r16
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
Reference in New Issue
Block a user