From 9dfb76b9de834fd89ab34fb2ca618ac928dc4e1c Mon Sep 17 00:00:00 2001
From: Nicola Gutierrez <nicolagutierrez.ng@gmail.com>
Date: Sat, 19 Feb 2022 13:56:15 +0100
Subject: [PATCH] Test HandleNext OK

---
 Src/mmr_can_scs_manager.c | 9 ++++++---
 1 file changed, 6 insertions(+), 3 deletions(-)

diff --git a/Src/mmr_can_scs_manager.c b/Src/mmr_can_scs_manager.c
index 4370363..3f0970f 100644
--- a/Src/mmr_can_scs_manager.c
+++ b/Src/mmr_can_scs_manager.c
@@ -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++;