avr: t03 can now send and receive messages!
will change other nodes from com2 interface to new network interface.
This commit is contained in:
@@ -17,12 +17,13 @@
|
||||
.equ UART_HW_READMODE_IDLE = 1
|
||||
.equ UART_HW_READMODE_READING = 2
|
||||
.equ UART_HW_READMODE_SKIPPING = 3
|
||||
.equ UART_HW_READMODE_MSGRECEIVED = 4
|
||||
|
||||
.equ UART_HW_WRITEMODE_OFF = 0
|
||||
.equ UART_HW_WRITEMODE_IDLE = 1
|
||||
.equ UART_HW_WRITEMODE_WRITING = 2
|
||||
.equ UART_HW_WRITEMODE_WAITBUFFEREMPTY = 3
|
||||
.equ UART_HW_WRITEMODE_WRITEBUFFEREMPTY = 4
|
||||
.equ UART_HW_WRITEMODE_IDLE = 16
|
||||
.equ UART_HW_WRITEMODE_WRITING = 17
|
||||
.equ UART_HW_WRITEMODE_WAITBUFFEREMPTY = 18
|
||||
.equ UART_HW_WRITEMODE_WRITEBUFFEREMPTY = 19
|
||||
|
||||
|
||||
.equ UART_HW_STATUS_UNDERRUN_BIT = 0
|
||||
|
||||
@@ -35,7 +35,7 @@ UART_HW_Interface_Init:
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine UART_HW_Interface_SetReadBuffer @global
|
||||
;
|
||||
; @param Y pointer to interface data in SRAM (see @ref UART_HW_IFACE_OFFS_STATE)
|
||||
; @param Y pointer to interface data in SRAM
|
||||
; @param r16 read buffer number
|
||||
; @param X pointer to read buffer
|
||||
; @clobbers R17
|
||||
@@ -48,6 +48,7 @@ UART_HW_Interface_SetReadBuffer:
|
||||
sbiw xh:xl, 1
|
||||
clr r17
|
||||
std Y+UART_HW_IFACE_OFFS_READBUFUSED, r17
|
||||
ldi r17, NET_BUFFERS_SIZE-1
|
||||
std Y+UART_HW_IFACE_OFFS_READBUFLEFT, r17
|
||||
ret
|
||||
; @end
|
||||
@@ -57,7 +58,7 @@ UART_HW_Interface_SetReadBuffer:
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine UART_HW_Interface_SetWriteBuffer @global
|
||||
;
|
||||
; @param Y pointer to interface data in SRAM (see @ref UART_HW_IFACE_OFFS_STATE)
|
||||
; @param Y pointer to interface data in SRAM
|
||||
; @param r16 write buffer number
|
||||
; @param X pointer to write buffer
|
||||
; @clobbers r17
|
||||
|
||||
@@ -29,7 +29,7 @@ UART_HW_Uart1_Init:
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine UART_HW_Uart1_StartRx @global
|
||||
;
|
||||
; @clobbers none
|
||||
; @clobbers R16
|
||||
|
||||
UART_HW_Uart1_StartRx:
|
||||
M_UART_HW_Uart_StartRx 1
|
||||
@@ -94,7 +94,7 @@ UART_HW_Uart1_Flush:
|
||||
; @routine UART_HW_Uart1_RxCharIsr @global
|
||||
;
|
||||
; @param Y pointer to interface data in SRAM (see @ref UART_HW_IFACE_OFFS_MODE)
|
||||
; @clobbers R16 (R17, R18, X)
|
||||
; @clobbers R16 (R17, R18, R24, R25, X)
|
||||
|
||||
UART_HW_Uart1_RxCharIsr:
|
||||
M_UART_HW_Uart_RxCharIsr 1
|
||||
|
||||
@@ -135,33 +135,91 @@ l_end_%:
|
||||
;
|
||||
; @param %0 UART number ("0" for UART0)
|
||||
; @param Y pointer to interface data in SRAM
|
||||
; @clobbers R16 (R17, R18, X)
|
||||
; @clobbers R16 (R17, R18, R24, R25, X)
|
||||
|
||||
.macro M_UART_HW_Uart_RxCharIsr
|
||||
#if 0
|
||||
; check for errors
|
||||
lds r16, UCSR@0A ; check for errors
|
||||
andi r16, (1<<FE@0) | (1<<DOR@0) | (1<<UPE@0)
|
||||
breq l_recv_% ; no error, receive next char
|
||||
ldd r16, Y+NET_IFACE_OFFS_STATUS ; set error status
|
||||
ori r16, (1<<UART_HW_STATUS_HWERR_BIT) ; -> HWERR
|
||||
rjmp l_setStatusAndEnd_%
|
||||
l_recv_%:
|
||||
brne l_hwerr_%
|
||||
; read char
|
||||
lds r16, UCSR@0A
|
||||
sbrs r16, RXC@0
|
||||
rjmp l_end_% ; no data
|
||||
lds r16, UDR@0
|
||||
rcall UART_HW_InterfaceWriteToReadBuffer ; (R17, R18, X)
|
||||
brcc l_overrun_%
|
||||
lds r16, UDR@0 ; r16=received char
|
||||
; check read mode
|
||||
ldd r17, Y+UART_HW_IFACE_OFFS_READMODE
|
||||
cpi r17, UART_HW_READMODE_READING
|
||||
breq l_storeChar_%
|
||||
cpi r17, UART_HW_READMODE_SKIPPING
|
||||
breq l_skipChar_%
|
||||
rjmp l_overrun_% ; neither read nor skip mode
|
||||
l_skipChar_%:
|
||||
clr r16
|
||||
std Y+NET_IFACE_OFFS_READTIMER, r16 ; reset read timer
|
||||
std Y+NET_IFACE_OFFS_READTIMER, r16 ; reset read timer
|
||||
rjmp l_end_%
|
||||
l_storeChar_%:
|
||||
mov r18, r16 ; r18=received char
|
||||
; check for buffer overrun
|
||||
ldd r17, Y+UART_HW_IFACE_OFFS_READBUFLEFT ; r17=bytes left
|
||||
tst r17
|
||||
breq l_econtent_% ; msg too long
|
||||
; actually store byte, increment/decrement counters and pos
|
||||
ldd xl, Y+UART_HW_IFACE_OFFS_READBUFPOS_LOW
|
||||
ldd xh, Y+UART_HW_IFACE_OFFS_READBUFPOS_HIGH
|
||||
st X+, r18 ; r18=byte to store
|
||||
clr r16
|
||||
std Y+NET_IFACE_OFFS_READTIMER, r16 ; reset read timer
|
||||
std Y+UART_HW_IFACE_OFFS_READBUFPOS_LOW, xl
|
||||
std Y+UART_HW_IFACE_OFFS_READBUFPOS_HIGH, xh
|
||||
ldd r18, Y+UART_HW_IFACE_OFFS_READBUFUSED ; r18=bytes in buffer
|
||||
inc r18
|
||||
std Y+UART_HW_IFACE_OFFS_READBUFUSED, r18
|
||||
dec r17
|
||||
std Y+UART_HW_IFACE_OFFS_READBUFLEFT, r17
|
||||
breq l_msgFinished_%
|
||||
; check msg size
|
||||
cpi r18, 2 ; bytes in buffer, exactly 2?
|
||||
brne l_end_% ; nope, done
|
||||
sbiw xh:xl, 1 ; yes, determine message length (msgLen at previous pos)
|
||||
ld r16, X+ ; read payload length byte
|
||||
subi r16, -3 ; add 3 (dest addr, length, crc byte)
|
||||
cpi r16, (NET_BUFFERS_SIZE-1) ; total msg length ok?
|
||||
brcc l_econtent_% ; content error (msg too long)
|
||||
subi r16, 2 ; subtract bytes already received
|
||||
std Y+UART_HW_IFACE_OFFS_READBUFLEFT, r16 ; set new number of bytes left
|
||||
brne l_end_% ; jmp if still bytes left to received
|
||||
l_msgFinished_%:
|
||||
ldd r16, Y+UART_HW_IFACE_OFFS_READBUFNUM
|
||||
rcall NET_AddIncomingMsgNum ; (R17, R18, X)
|
||||
brcs l_msgStored_%
|
||||
; msg complete but could not store
|
||||
rcall NET_Buffer_Locate
|
||||
rcall UART_HW_Interface_SetReadBuffer ; reset/reuse current buffer
|
||||
ldi r16, NET_IFACE_OFFS_ERR_NOBUF_LOW
|
||||
ldi r17, UART_HW_READMODE_READING
|
||||
rjmp l_incCounterAndEnterMode_%
|
||||
l_msgStored_%:
|
||||
ldi r16, NET_IFACE_OFFS_PACKETSIN_LOW
|
||||
ldi r17, UART_HW_READMODE_MSGRECEIVED
|
||||
rjmp l_incCounterAndEnterMode_%
|
||||
l_hwerr_%:
|
||||
ldi r16, NET_IFACE_OFFS_ERR_IO_LOW
|
||||
rcall NET_Interface_IncCounter16
|
||||
ldi r16, UART_HW_READMODE_SKIPPING
|
||||
std Y+UART_HW_IFACE_OFFS_READMODE, r16 ; set read mode
|
||||
rjmp l_end_%
|
||||
l_econtent_%:
|
||||
ldi r16, NET_IFACE_OFFS_ERR_CONTENT_LOW
|
||||
rjmp l_incCounterAndEnterSkipping_%
|
||||
l_overrun_%:
|
||||
ldd r16, Y+NET_IFACE_OFFS_STATUS ; set overrun error
|
||||
ori r16, (1<<UART_HW_STATUS_OVERRUN_BIT) ; -> OVERRUN
|
||||
l_setStatusAndEnd_%:
|
||||
std Y+NET_IFACE_OFFS_STATUS, r16
|
||||
ldi r16, NET_IFACE_OFFS_ERR_NOBUF_LOW
|
||||
l_incCounterAndEnterSkipping_%:
|
||||
ldi r17, UART_HW_READMODE_SKIPPING
|
||||
l_incCounterAndEnterMode_%:
|
||||
rcall NET_Interface_IncCounter16 ; (R24, R25)
|
||||
std Y+UART_HW_IFACE_OFFS_READMODE, r17 ; set read mode
|
||||
l_end_%:
|
||||
#endif
|
||||
.endmacro
|
||||
; @end
|
||||
|
||||
|
||||
@@ -73,17 +73,21 @@ TtyOnUart1_RxCharIsr:
|
||||
push r16
|
||||
push r17
|
||||
push r18
|
||||
push xl
|
||||
push xh
|
||||
push yl
|
||||
push yh
|
||||
ldi yl, LOW(ttyOnUart1_iface)
|
||||
ldi yh, HIGH(ttyOnUart1_iface)
|
||||
rcall UART_HW_Uart1_RxCharIsr ; (R16, R17, R18, X)
|
||||
pop yh
|
||||
pop yl
|
||||
pop xh
|
||||
pop xl
|
||||
push r24
|
||||
push r25
|
||||
push xl
|
||||
push xh
|
||||
push yl
|
||||
push yh
|
||||
ldi yl, LOW(ttyOnUart1_iface)
|
||||
ldi yh, HIGH(ttyOnUart1_iface)
|
||||
rcall UART_HW_Uart1_RxCharIsr ; (R16, R17, R18, R24, R25, X)
|
||||
pop yh
|
||||
pop yl
|
||||
pop xh
|
||||
pop xl
|
||||
pop r25
|
||||
pop r24
|
||||
pop r18
|
||||
pop r17
|
||||
pop r16
|
||||
@@ -159,7 +163,7 @@ TtyOnUart1_TxCharIsr:
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine TtyOnUart1_SendBuffer @global
|
||||
;
|
||||
; @clobbers R17
|
||||
; @clobbers R16, R17
|
||||
|
||||
TtyOnUart1_SendBuffer:
|
||||
push r15
|
||||
@@ -198,7 +202,7 @@ TtyOnUart1_Run:
|
||||
ldi yh, HIGH(ttyOnUart1_iface)
|
||||
|
||||
rcall ttyOnUart1RunWriteModes
|
||||
; rcall ttyOnUart1RunReadModes
|
||||
rcall ttyOnUart1RunReadModes
|
||||
pop r15
|
||||
out SREG, r15
|
||||
ret
|
||||
@@ -213,6 +217,8 @@ TtyOnUart1_Run:
|
||||
|
||||
ttyOnUart1RunWriteModes:
|
||||
ldd r16, Y+UART_HW_IFACE_OFFS_WRITEMODE ; handle write functions
|
||||
cpi r16, UART_HW_WRITEMODE_IDLE
|
||||
breq ttyOnUart1RunIdle
|
||||
cpi r16, UART_HW_WRITEMODE_WRITING
|
||||
breq ttyOnUart1RunWriting
|
||||
cpi r16, UART_HW_WRITEMODE_WAITBUFFEREMPTY
|
||||
@@ -224,6 +230,21 @@ ttyOnUart1RunWriteModes:
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine ttyOnUart1RunIdle
|
||||
;
|
||||
; @clobbers
|
||||
|
||||
ttyOnUart1RunIdle:
|
||||
rcall NET_Interface_GetNextOutgoingMsgNum ; (R17, R18, X)
|
||||
brcc ttyOnUart1RunIdle_end
|
||||
rcall NET_Buffer_Locate ; (R17)
|
||||
brcc ttyOnUart1RunIdle_end
|
||||
rcall TtyOnUart1_SendBuffer ; (R16, R17)
|
||||
ttyOnUart1RunIdle_end:
|
||||
ret
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine ttyOnUart1RunWriting
|
||||
;
|
||||
@@ -264,6 +285,8 @@ ttyOnUart1RunWriteBufferEmpty_setIdle:
|
||||
rcall UART_HW_Uart1_StopTx ; disable transceiver and interrupts (R16)
|
||||
ldi r16, UART_HW_WRITEMODE_IDLE
|
||||
std Y+UART_HW_IFACE_OFFS_WRITEMODE, r16
|
||||
ldi r16, NET_IFACE_OFFS_PACKETSOUT_LOW ; increment packets counter
|
||||
rcall NET_Interface_IncCounter16 ; (R24, R25)
|
||||
ret
|
||||
; @end
|
||||
|
||||
@@ -275,6 +298,95 @@ ttyOnUart1RunWriteBufferEmpty_setIdle:
|
||||
; @clobbers all, !Y
|
||||
|
||||
ttyOnUart1RunReadModes:
|
||||
ldd r16, Y+UART_HW_IFACE_OFFS_READMODE ; handle read functions
|
||||
cpi r16, UART_HW_READMODE_IDLE
|
||||
breq ttyOnUart1RunReadIdle ; (R16, R17, R24, R25, X)
|
||||
cpi r16, UART_HW_READMODE_READING
|
||||
breq ttyOnUart1RunReading ; (none)
|
||||
cpi r16, UART_HW_READMODE_SKIPPING
|
||||
breq ttyOnUart1RunSkipping ; (R16)
|
||||
cpi r16, UART_HW_READMODE_MSGRECEIVED
|
||||
breq ttyOnUart1RunMsgReceived ; (R16, R17, R18, R24, R25)
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine ttyOnUart1RunReadIdle
|
||||
;
|
||||
; @clobbers R16 (R17, R24, R25, X)
|
||||
|
||||
ttyOnUart1RunReadIdle:
|
||||
ldd r16, Y+UART_HW_IFACE_OFFS_READBUFNUM
|
||||
cpi r16, 0xff
|
||||
brne ttyOnUart1RunReadIdle_enterReading
|
||||
rcall NET_Buffer_Alloc ; (R16, R17, X)
|
||||
brcc ttyOnUart1RunReadIdle_noBuf
|
||||
rcall UART_HW_Interface_SetReadBuffer ; (R17)
|
||||
ttyOnUart1RunReadIdle_enterReading:
|
||||
ldi r16, UART_HW_READMODE_READING
|
||||
std Y+UART_HW_IFACE_OFFS_READMODE, r16
|
||||
rcall UART_HW_Uart1_StartRx ; R16
|
||||
ret
|
||||
ttyOnUart1RunReadIdle_noBuf:
|
||||
ldi r16, NET_IFACE_OFFS_ERR_NOBUF_LOW
|
||||
rcall NET_Interface_IncCounter16 ; (R24, R25)
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine ttyOnUart1RunReading
|
||||
;
|
||||
; @clobbers none
|
||||
|
||||
ttyOnUart1RunReading:
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine ttyOnUart1RunSkipping
|
||||
;
|
||||
; @clobbers R16
|
||||
|
||||
ttyOnUart1RunSkipping:
|
||||
ldd r16, Y+NET_IFACE_OFFS_READTIMER
|
||||
cpi r16, 2
|
||||
brcs ttyOnUart1RunSkipping_end
|
||||
ldi r16, UART_HW_READMODE_IDLE
|
||||
std Y+UART_HW_IFACE_OFFS_READMODE, r16
|
||||
ttyOnUart1RunSkipping_end:
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @routine ttyOnUart1RunMsgReceived
|
||||
;
|
||||
; @clobbers R16 (R17, R18, R24, R25)
|
||||
|
||||
ttyOnUart1RunMsgReceived:
|
||||
ldd r16, Y+UART_HW_IFACE_OFFS_READBUFNUM
|
||||
cpi r16, 0xff
|
||||
breq ttyOnUart1RunMsgReceived_end
|
||||
rcall NET_AddIncomingMsgNum ; (R17, R18, X)
|
||||
brcs ttyOnUart1RunMsgReceived_enterIdle
|
||||
ttyOnUart1RunMsgReceived_overrun: ; reset/reuse current buffer
|
||||
rcall NET_Buffer_Locate
|
||||
rcall UART_HW_Interface_SetReadBuffer ; (R17)
|
||||
ldi r16, NET_IFACE_OFFS_ERR_NOBUF_LOW
|
||||
rcall NET_Interface_IncCounter16 ; (R24, R25)
|
||||
ttyOnUart1RunMsgReceived_enterIdle:
|
||||
ldi r16, 0xff
|
||||
std Y+UART_HW_IFACE_OFFS_READBUFNUM, r16
|
||||
ldi r16, UART_HW_READMODE_IDLE
|
||||
std Y+UART_HW_IFACE_OFFS_READMODE, r16
|
||||
ttyOnUart1RunMsgReceived_end:
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
Reference in New Issue
Block a user