Test HandleNext OK

This commit is contained in:
Nicola Gutierrez
2022-02-19 13:56:15 +01:00
parent 7190dbcdf9
commit 9dfb76b9de
+6 -3
View File
@@ -60,7 +60,10 @@ HalStatus MMR_CAN_SendScs(
HalStatus MMR_CAN_HandleNextScs(CanHandle *hcan) {
static int counter = 0;
MmrCanScsEntry *entry = &__scsEntries[counter++ % MMR_CAN_SCS_ENTRIES_COUNT];
MmrCanScsEntry *entry = &__scsEntries[counter];
counter++;
counter %= MMR_CAN_SCS_ENTRIES_COUNT;
if (MMR_CAN_HeaderToBits(entry->header) == 0) {
return HAL_OK;
@@ -104,8 +107,8 @@ TimerRange getCurrentTime() {
void maybeIncrementRTR(MmrCanScsEntry *entry) {
TimerRange delay =
getCurrentTime() - entry->counter;
TimerRange now = getCurrentTime();
TimerRange delay = now - entry->counter;
if (delay >= MMR_CAN_MAX_TIMEOUT) {
entry->rtr++;