159 lines
4.1 KiB
NASM
159 lines
4.1 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. *
|
|
; ***************************************************************************
|
|
|
|
|
|
|
|
; ***************************************************************************
|
|
; defines
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; network interfaces
|
|
|
|
.equ NETDEV0_IFACENUM = 1
|
|
.equ NETDEV1_IFACENUM = 2
|
|
|
|
|
|
|
|
; ***************************************************************************
|
|
; code
|
|
|
|
.cseg
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; @routine AppRouter_Init @global
|
|
|
|
AppRouter_Init:
|
|
; set interface number for NETDEV0
|
|
ldi r16, NETDEV0_IFACENUM
|
|
sts netInterfaceData+NET_IFACE_OFFS_IFACENUM, r16
|
|
; set interface number for NETDEV1
|
|
ldi r16, NETDEV1_IFACENUM
|
|
sts netInterfaceData2+NET_IFACE_OFFS_IFACENUM, r16
|
|
ret
|
|
; @end
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; @routine AppRouter_Run @global
|
|
;
|
|
; Read messages from either interface and forward to the other one.
|
|
|
|
AppRouter_Run:
|
|
rjmp appRouterCheckRecvdMsg
|
|
; @end
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; @routine appRouterCheckRecvdMsg
|
|
;
|
|
; Read messages from either interface and forward to the other one.
|
|
|
|
appRouterCheckRecvdMsg:
|
|
rcall NET_PeekNextIncomingMsgNum ; check read queue (bufNum->r16)
|
|
brcc appRouterCheckRecvdMsg_end ; no msg, jmp
|
|
rcall NET_Buffer_Locate ; (R17)
|
|
; let system handle incoming messages
|
|
push r16
|
|
adiw xh:xl, 1
|
|
rcall appRouterLetSysHandleMsg
|
|
sbiw xh:xl, 1
|
|
pop r16
|
|
|
|
; forward to other interface
|
|
ld r17, X
|
|
andi r17, (1<<NET_IFACE_BUFFER_IFACENUM1_BIT) | (1<<NET_IFACE_BUFFER_IFACENUM0_BIT)
|
|
rcall appRouterReverseInterfaceNum ; (R16, R17)
|
|
rcall appRouterAddMsgToInterface
|
|
brcc appRouterCheckRecvdMsg_end ; could not add, jmp
|
|
rcall NET_GetNextIncomingMsgNum ; take off the queue
|
|
rjmp appRouterCheckRecvdMsg
|
|
appRouterCheckRecvdMsg_end:
|
|
ret
|
|
; @end
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; @routine appRouterLetSysHandleMsg
|
|
;
|
|
; @param X pointer to msg to handle (point behind the buffer header!)
|
|
; @clobbers any, !X
|
|
|
|
appRouterLetSysHandleMsg:
|
|
ld r16, X
|
|
cpi r16, 0xff
|
|
breq appRouterLetSysHandleMsg_forMe
|
|
lds r17, netInterfaceData+NET_IFACE_OFFS_ADDRESS
|
|
cp r16, r17
|
|
brne appRouterLetSysHandleMsg_end
|
|
appRouterLetSysHandleMsg_forMe:
|
|
push xl
|
|
push xh
|
|
rcall onMessageReceived
|
|
pop xh
|
|
pop xl
|
|
push xl
|
|
push xh
|
|
rcall mainModulesOnPacketReceived
|
|
pop xh
|
|
pop xl
|
|
push xl
|
|
push xh
|
|
rcall mainAppsOnPacketReceived
|
|
pop xh
|
|
pop xl
|
|
appRouterLetSysHandleMsg_end:
|
|
ret
|
|
; @end
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; @routine appRouterReverseInterfaceNum
|
|
;
|
|
; @param r17 buffer num
|
|
; @return r17 reversed interface number
|
|
; @clobbers r16, r17
|
|
|
|
appRouterReverseInterfaceNum:
|
|
ldi r16, (1<<NET_IFACE_BUFFER_IFACENUM1_BIT) | (1<<NET_IFACE_BUFFER_IFACENUM0_BIT)
|
|
eor r17, r16
|
|
and r17, r16
|
|
ret
|
|
; @end
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; @routine appRouterAddMsgToInterface
|
|
; @param r16 buffer num
|
|
; @param r17 interface num
|
|
|
|
appRouterAddMsgToInterface:
|
|
cpi r17, NETDEV0_IFACENUM
|
|
brne appRouterAddMsgToInterface_notNetDev0
|
|
ldi yl, LOW(netInterfaceData)
|
|
ldi yh, HIGH(netInterfaceData)
|
|
rjmp NET_Interface_AddOutgoingMsgNum ; try to add msg to interface
|
|
appRouterAddMsgToInterface_notNetDev0:
|
|
ldi yl, LOW(netInterfaceData2)
|
|
ldi yh, HIGH(netInterfaceData2)
|
|
rjmp NET_Interface_AddOutgoingMsgNum ; try to add msg to interface
|
|
appRouterAddMsgToInterface_end:
|
|
clc
|
|
ret
|
|
; @end
|
|
|
|
|
|
|
|
|
|
|