use led_activity.
This commit is contained in:
@@ -279,9 +279,6 @@ uartFd1CheckSkipping:
|
|||||||
cbr r16, (1<<UARTFD_IFACE_STATUS_BIT_SKIPPING)
|
cbr r16, (1<<UARTFD_IFACE_STATUS_BIT_SKIPPING)
|
||||||
std Y+UARTFD_IFACE_OFFS_STATUS, r16
|
std Y+UARTFD_IFACE_OFFS_STATUS, r16
|
||||||
|
|
||||||
ldi r16, T03_FLAGS_I1_RESTARTED
|
|
||||||
rcall LedSignal_SetFlag
|
|
||||||
|
|
||||||
rcall uartFd1RestartReading ; (R16, X)
|
rcall uartFd1RestartReading ; (R16, X)
|
||||||
out SREG, r15
|
out SREG, r15
|
||||||
pop r15
|
pop r15
|
||||||
@@ -452,14 +449,17 @@ uartFd1RestartReading:
|
|||||||
; @clobbers r16, r17, r18, X, Z (r19, r20, r24, r25)
|
; @clobbers r16, r17, r18, X, Z (r19, r20, r24, r25)
|
||||||
|
|
||||||
uartFd1FinishReading:
|
uartFd1FinishReading:
|
||||||
|
; check message
|
||||||
mov xl, yl
|
mov xl, yl
|
||||||
mov xh, yh
|
mov xh, yh
|
||||||
adiw xh:xl, UARTFD_IFACE_OFFS_RBUFFER
|
adiw xh:xl, UARTFD_IFACE_OFFS_RBUFFER
|
||||||
rcall NETMSG_CheckMessageInBuffer ; (R16, R17, R18, R19, R20, X)
|
rcall NETMSG_CheckMessageInBuffer ; (R16, R17, R18, R19, R20, X)
|
||||||
brcc uartFd1FinishReading_errorCrc
|
brcc uartFd1FinishReading_errorCrc
|
||||||
|
; allocate buffer for storage
|
||||||
rcall NET_Buffer_Alloc ; R16=number, X=ptr (R16, R17, X)
|
rcall NET_Buffer_Alloc ; R16=number, X=ptr (R16, R17, X)
|
||||||
brcc uartFd1FinishReading_errorMem
|
brcc uartFd1FinishReading_errorMem
|
||||||
ldd r18, Y+NET_IFACE_OFFS_IFACENUM
|
ldd r18, Y+NET_IFACE_OFFS_IFACENUM
|
||||||
|
andi r18, 0x0f
|
||||||
ld r17, X
|
ld r17, X
|
||||||
andi r17, 0xf0
|
andi r17, 0xf0
|
||||||
or r17, r18
|
or r17, r18
|
||||||
@@ -477,10 +477,11 @@ uartFd1FinishReading_copyLoop:
|
|||||||
rcall NET_AddIncomingMsgNum
|
rcall NET_AddIncomingMsgNum
|
||||||
brcs uartFd1FinishReading_msgSaved
|
brcs uartFd1FinishReading_msgSaved
|
||||||
rcall NET_Buffer_ReleaseByNum ; (R16, X)
|
rcall NET_Buffer_ReleaseByNum ; (R16, X)
|
||||||
ldi r16, T03_FLAGS_ADDIN
|
|
||||||
rcall LedSignal_SetFlag ; (r17)
|
|
||||||
rjmp uartFd1FinishReading_errorMem
|
rjmp uartFd1FinishReading_errorMem
|
||||||
uartFd1FinishReading_msgSaved:
|
uartFd1FinishReading_msgSaved:
|
||||||
|
#ifdef MODULES_LED_ACTIVITY
|
||||||
|
rcall LedActivity_Trigger ; (r16)
|
||||||
|
#endif
|
||||||
ldi r16, NET_IFACE_OFFS_PACKETSIN_LOW
|
ldi r16, NET_IFACE_OFFS_PACKETSIN_LOW
|
||||||
rjmp uartFd1FinishReading_incCounter
|
rjmp uartFd1FinishReading_incCounter
|
||||||
uartFd1FinishReading_errorCrc:
|
uartFd1FinishReading_errorCrc:
|
||||||
|
|||||||
Reference in New Issue
Block a user