nikon/CANopenNode
1
0
Fork 0
Code Activity Actions

Update CO_SYNC.c

Browse source 
`*timerNext_us` added also to 'Verify timeout'
This commit is contained in:
Janez 2020-01-31 12:25:22 +01:00
parent 729a139c12
commit 1de453c92f
1 changed files with 11 additions and 2 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

13
stack/CO_SYNC.c
View file

@ -363,8 +363,17 @@ uint8_t CO_SYNC_process(
}
/* Verify timeout of SYNC */
if(SYNC->periodTime && SYNC->timer > SYNC->periodTimeoutTime && *SYNC->operatingState == CO_NMT_OPERATIONAL)
CO_errorReport(SYNC->em, CO_EM_SYNC_TIME_OUT, CO_EMC_COMMUNICATION, SYNC->timer);
if(SYNC->periodTime && *SYNC->operatingState == CO_NMT_OPERATIONAL) {
if(SYNC->timer > SYNC->periodTimeoutTime) {
CO_errorReport(SYNC->em, CO_EM_SYNC_TIME_OUT, CO_EMC_COMMUNICATION, SYNC->timer);
}
else if(timerNext_us != NULL) {
uint32_t diff = SYNC->periodTimeoutTime - SYNC->timer;
if(*timerNext_us > diff){
*timerNext_us = diff;
}
}
}
}
else {
CO_CANrxNew_CLEAR(SYNC->CANrxNew);