Add SCS manager

bozza

Src/mmr_can_scs_manager.c

@@ -0,0 +1,61 @@
+#include "mmr_can_scs_manager.h"
+
+static RTRresponse arr_scs[MMR_SCS_NR_TIMERS];
+
+static RTRresponse* findResponse(MmrCanMessageId scsId, CanId receiverId);
+
+
+bool SetRTRresponse(MmrCanMessageId scsId, CanId receiverId, int rtr)
+{
+    RTRresponse *response = findResponse(0, 0);
+    if (response == NULL) return false;
+
+    response->scsId = scsId;
+    response->receiverId = receiverId;
+    response->rtr = 0;
+
+    return MMR_CAN_SetTimerSCS(response->scsId, response->receiverId, MMR_CAN_GetCurrentTime);
+}
+
+void CheckSCS()
+{
+    if (counter>=MMR_SCS_NR_TIMERS) counter=0;
+
+    RTRresponse *_rtrResponse = &arr_scs[counter];
+
+    if(!MMR_CAN_GetTimerSCS(_rtrResponse->scsId, _rtrResponse->receiverId, &_rtrResponse->rtr, MMR_CAN_GetCurrentTime, 500))
+    {
+      // do something
+    }
+
+    counter++;
+
+    if (_rtrResponse->rtr==1)
+    {
+      // Return ritrasmission
+    }
+
+    if (_rtrResponse->rtr>1)
+    {
+      // Return Safe State
+    }
+}
+
+
+TimerRange MMR_CAN_GetCurrentTime()
+{
+  return 0; //TODO: HAL....
+}
+
+RTRresponse* findResponse(MmrCanMessageId scsId, CanId receiverId) {
+  int i = 0;
+  for (; i < MMR_SCS_NR_TIMERS; i++) {
+    RTRresponse *response = arr_scs + i;
+
+    if (response->scsId == scsId && response->receiverId == receiverId) {
+      return response;
+    }
+  }
+
+  return NULL;
+}

Src/mmr_can_send_scs.c

@@ -1,4 +1,5 @@
 #include "mmr_can.h"
+#include "mmr_can_scs_manager.h" 
 
 
 HalStatus MMR_CAN_SendSCS(
@@ -16,6 +17,11 @@ HalStatus MMR_CAN_SendSCS(
     .mailbox = mailbox,
     .length = 0,
   };
+
+  if(!MMR_CAN_SetRTRresponse()) 
+  {
+    // do something
+  }
   
   return MMR_CAN_Send(hcan, packet);
 }

Src/mmr_can_timer_scs.c

@@ -1,6 +1,6 @@
-#include "mmr_can.h"
+#include "mmr_can_timer_scs.h"
 
-static MmrTimerSCS arr_timer[MMR_SCS_NR_TIMERS] = {};
+static MmrTimerSCS arr_timer[MMR_SCS_NR_TIMERS];
 
 static MmrTimerSCS* findTimer(MmrCanMessageId scsId, CanId receiverId);
 
@@ -17,9 +17,7 @@ void MMR_CAN_InitTimerSCS() {
 
 bool MMR_CAN_ClearTimerSCS(MmrCanMessageId scsId, CanId receiverId) {
   MmrTimerSCS *timer = findTimer(scsId, receiverId);
-  if (timer == NULL) {
-    return false;
-  }
+  if (timer == NULL) return false;
 
   timer->scsId = 0;
   timer->receiverId = 0;
@@ -29,10 +27,8 @@ bool MMR_CAN_ClearTimerSCS(MmrCanMessageId scsId, CanId receiverId) {
 
 
 bool MMR_CAN_SetTimerSCS(MmrCanMessageId scsId, CanId receiverId, TimerRange currentTime) {
-  MmrTimerSCS *timer = findTimer(scsId, receiverId);
-  if (timer == NULL) {
-    return false;
-  }
+  MmrTimerSCS *timer = findTimer(0, 0);
+  if (timer == NULL) return false;
 
   timer->scsId = scsId;
   timer->receiverId = receiverId;
@@ -41,18 +37,12 @@ bool MMR_CAN_SetTimerSCS(MmrCanMessageId scsId, CanId receiverId, TimerRange cur
 }
 
 
-bool MMR_CAN_GetTimerSCS(RTRresponse *rtrResponse, TimerRange currentTime, TimerRange thresholdDelay) {
-  MmrTimerSCS *timer = findTimer(
-    rtrResponse->scsId,
-    rtrResponse->receiverId
-  );
-
-  if (timer == NULL) {
-    return false;
-  }
+bool MMR_CAN_GetTimerSCS(MmrCanMessageId scsId, CanId receiverId, int *rtr, TimerRange currentTime, TimerRange thresholdDelay) {
+  MmrTimerSCS *timer = findTimer(scsId, receiverId);
+  if (timer == NULL) return false;
 
   if (currentTime - timer->counter >= thresholdDelay) {
-    rtrResponse->rtr++;
+    rtr++;
   }
   return true;
 }
@@ -63,7 +53,7 @@ MmrTimerSCS* findTimer(MmrCanMessageId scsId, CanId receiverId) {
   for (; i < MMR_SCS_NR_TIMERS; i++) {
     MmrTimerSCS *timer = arr_timer + i;
 
-    if (timer->scsId == scsId && arr_timer->receiverId == receiverId) {
+    if (timer->scsId == scsId && timer->receiverId == receiverId) {
       return timer;
     }
   }