try new implementation of UART code for m8515.
This commit is contained in:
@@ -86,6 +86,7 @@
|
||||
M_IO_READ r16, UCSR@0A
|
||||
cbr r16, (1<<TXC@0) ; clear TXCn interrupt
|
||||
M_IO_WRITE UCSR@0A, r16
|
||||
|
||||
M_IO_READ r16, UCSR@0B
|
||||
sbr r16, (1<<UDRIE@0) | (1<<TXC@0) | (1<<TXEN@0) ; enable TX UDRE and TXC1 interrupt, enable transceive
|
||||
M_IO_WRITE UCSR@0B, r16
|
||||
@@ -207,6 +208,9 @@ l_msgFinished_%:
|
||||
ldi r17, UART_HW_READMODE_MSGRECEIVED
|
||||
rjmp l_incCounterAndEnterMode_%
|
||||
l_hwerr_%:
|
||||
sbrc r16, DOR ; (1<<FE@0) | (1<<DOR@0) | (1<<UPE@0)
|
||||
rjmp DEBUG2
|
||||
|
||||
ldi r16, NET_IFACE_OFFS_ERR_IO_LOW
|
||||
rjmp l_incCounterAndEnterSkipping_%
|
||||
l_econtent_%:
|
||||
@@ -227,6 +231,90 @@ l_end_%:
|
||||
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @macro M_UART_HW_Uart_EnterReceivedChar
|
||||
;
|
||||
; @param %0 UART number ("0" for UART0)
|
||||
; @param r16 received char
|
||||
; @param Y pointer to interface data in SRAM
|
||||
; @clobbers R16 (R17, R18, R24, R25, X)
|
||||
|
||||
.macro M_UART_HW_Uart_EnterReceivedChar
|
||||
; 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
|
||||
rjmp l_end_%
|
||||
l_storeChar_%:
|
||||
mov r18, r16 ; r18=received char
|
||||
; check buffer
|
||||
ldd r16, Y+UART_HW_IFACE_OFFS_READBUFNUM
|
||||
cpi r16, 0xff
|
||||
breq l_overrun_%
|
||||
|
||||
; 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
|
||||
inc r16 ; + dest addr
|
||||
inc r16 ; + msg length
|
||||
inc r16 ; + CRC byte
|
||||
cpi r16, (NET_BUFFERS_SIZE-2) ; total msg length ok? (subtract 1 for buffer header byte)
|
||||
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 receive
|
||||
|
||||
l_msgFinished_%:
|
||||
M_UART_HW_Uart_StopRx @0 ; (R16)
|
||||
ldi r16, NET_IFACE_OFFS_PACKETSIN_LOW
|
||||
ldi r17, UART_HW_READMODE_MSGRECEIVED
|
||||
rjmp l_incCounterAndEnterMode_%
|
||||
l_econtent_%:
|
||||
ldi r16, NET_IFACE_OFFS_ERR_CONTENT_LOW
|
||||
rjmp l_incCounterAndEnterSkipping_%
|
||||
l_overrun_%:
|
||||
ldi r16, NET_IFACE_OFFS_ERR_NOBUF_LOW
|
||||
l_incCounterAndEnterSkipping_%:
|
||||
M_UART_HW_Uart_StopRx @0 ; (R16)
|
||||
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_%:
|
||||
.endmacro
|
||||
; @end
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; @macro M_UART_HW_Uart_RxCharFullDuplexIsr
|
||||
;
|
||||
|
||||
Reference in New Issue
Block a user