Fix nasa#179, Light initialization logic refactor + remove multiple r…

…eturns
thnkslprpt · Dec 12, 2023 · cc850eb · cc850eb
1 parent ec09026
commit cc850eb
Show file tree

Hide file tree

Showing 2 changed files with 74 additions and 58 deletions.
diff --git a/fsw/src/to_lab_app.c b/fsw/src/to_lab_app.c
@@ -118,94 +118,109 @@ CFE_Status_t TO_LAB_init(void)
     if (status != CFE_SUCCESS)
     {
         CFE_ES_WriteToSysLog("TO_LAB: Error registering for Event Services, RC = 0x%08X\n", (unsigned int)status);
-        return status;
     }
 
-    /*
-    ** Initialize housekeeping packet (clear user data area)...
-    */
-    CFE_MSG_Init(CFE_MSG_PTR(TO_LAB_Global.HkTlm.TelemetryHeader), CFE_SB_ValueToMsgId(TO_LAB_HK_TLM_MID),
-                 sizeof(TO_LAB_Global.HkTlm));
+    if (status == CFE_SUCCESS)
+    {
+        /*
+        ** Initialize housekeeping packet (clear user data area)...
+        */
+        CFE_MSG_Init(CFE_MSG_PTR(TO_LAB_Global.HkTlm.TelemetryHeader), CFE_SB_ValueToMsgId(TO_LAB_HK_TLM_MID),
+                     sizeof(TO_LAB_Global.HkTlm));
 
-    status =
-        CFE_TBL_Register(&TO_LAB_Global.SubsTblHandle, "TO_LAB_Subs", sizeof(TO_LAB_Subs_t), CFE_TBL_OPT_DEFAULT, NULL);
+        status = CFE_TBL_Register(&TO_LAB_Global.SubsTblHandle, "TO_LAB_Subs", sizeof(TO_LAB_Subs_t),
+                                  CFE_TBL_OPT_DEFAULT, NULL);
 
-    if (status != CFE_SUCCESS)
-    {
-        CFE_EVS_SendEvent(TO_LAB_TBL_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't register table status %i",
-                          __LINE__, (int)status);
-        return status;
+        if (status != CFE_SUCCESS)
+        {
+            CFE_EVS_SendEvent(TO_LAB_TBL_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't register table status %i",
+                              __LINE__, (int)status);
+        }
     }
 
-    status = CFE_TBL_Load(TO_LAB_Global.SubsTblHandle, CFE_TBL_SRC_FILE, "/cf/to_lab_sub.tbl");
-
-    if (status != CFE_SUCCESS)
+    if (status == CFE_SUCCESS)
     {
-        CFE_EVS_SendEvent(TO_LAB_TBL_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't load table status %i", __LINE__,
-                          (int)status);
-        return status;
-    }
+        status = CFE_TBL_Load(TO_LAB_Global.SubsTblHandle, CFE_TBL_SRC_FILE, "/cf/to_lab_sub.tbl");
 
-    status = CFE_TBL_GetAddress((void **)&TblPtr, TO_LAB_Global.SubsTblHandle);
+        if (status != CFE_SUCCESS)
+        {
+            CFE_EVS_SendEvent(TO_LAB_TBL_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't load table status %i",
+                              __LINE__, (int)status);
+        }
+    }
 
-    if (status != CFE_SUCCESS && status != CFE_TBL_INFO_UPDATED)
+    if (status == CFE_SUCCESS)
     {
-        CFE_EVS_SendEvent(TO_LAB_TBL_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't get table addr status %i",
-                          __LINE__, (int)status);
-        return status;
+        status = CFE_TBL_GetAddress((void **)&TblPtr, TO_LAB_Global.SubsTblHandle);
+
+        if (status != CFE_SUCCESS && status != CFE_TBL_INFO_UPDATED)
+        {
+            CFE_EVS_SendEvent(TO_LAB_TBL_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't get table addr status %i",
+                              __LINE__, (int)status);
+        }
     }
 
-    TO_LAB_Global.SubsTblPtr = TblPtr; /* Save returned address */
+    if (status == CFE_SUCCESS || status == CFE_TBL_INFO_UPDATED)
+    {
+        TO_LAB_Global.SubsTblPtr = TblPtr; /* Save returned address */
+
+        /* Subscribe to my commands */
+        status = CFE_SB_CreatePipe(&TO_LAB_Global.Cmd_pipe, PipeDepth, PipeName);
+        if (status != CFE_SUCCESS)
+        {
+            CFE_EVS_SendEvent(TO_LAB_CR_PIPE_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't create cmd pipe status %i",
+                              __LINE__, (int)status);
+        }
+    }
 
-    /* Subscribe to my commands */
-    status = CFE_SB_CreatePipe(&TO_LAB_Global.Cmd_pipe, PipeDepth, PipeName);
     if (status == CFE_SUCCESS)
     {
+
         CFE_SB_Subscribe(CFE_SB_ValueToMsgId(TO_LAB_CMD_MID), TO_LAB_Global.Cmd_pipe);
         CFE_SB_Subscribe(CFE_SB_ValueToMsgId(TO_LAB_SEND_HK_MID), TO_LAB_Global.Cmd_pipe);
-    }
-    else
-        CFE_EVS_SendEvent(TO_LAB_CR_PIPE_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't create cmd pipe status %i",
-                          __LINE__, (int)status);
 
-    /* Create TO TLM pipe */
-    status = CFE_SB_CreatePipe(&TO_LAB_Global.Tlm_pipe, ToTlmPipeDepth, ToTlmPipeName);
-    if (status != CFE_SUCCESS)
-    {
-        CFE_EVS_SendEvent(TO_LAB_TLMPIPE_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't create Tlm pipe status %i",
-                          __LINE__, (int)status);
+        /* Create TO TLM pipe */
+        status = CFE_SB_CreatePipe(&TO_LAB_Global.Tlm_pipe, ToTlmPipeDepth, ToTlmPipeName);
+        if (status != CFE_SUCCESS)
+        {
+            CFE_EVS_SendEvent(TO_LAB_TLMPIPE_ERR_EID, CFE_EVS_EventType_ERROR, "L%d TO Can't create Tlm pipe status %i",
+                              __LINE__, (int)status);
+        }
     }
 
-    /* Subscriptions for TLM pipe*/
-    SubEntry = TO_LAB_Global.SubsTblPtr->Subs;
-    for (i = 0; i < TO_LAB_MAX_SUBSCRIPTIONS; i++)
+    if (status == CFE_SUCCESS)
     {
-        if (!CFE_SB_IsValidMsgId(SubEntry->Stream))
+        /* Subscriptions for TLM pipe*/
+        SubEntry = TO_LAB_Global.SubsTblPtr->Subs;
+        for (i = 0; i < TO_LAB_MAX_SUBSCRIPTIONS; i++)
         {
-            /* Only process until invalid MsgId is found*/
-            break;
-        }
+            if (!CFE_SB_IsValidMsgId(SubEntry->Stream))
+            {
+                /* Only process until invalid MsgId is found*/
+                break;
+            }
 
-        status = CFE_SB_SubscribeEx(SubEntry->Stream, TO_LAB_Global.Tlm_pipe, SubEntry->Flags, SubEntry->BufLimit);
-        if (status != CFE_SUCCESS)
-        {
-            CFE_EVS_SendEvent(TO_LAB_SUBSCRIBE_ERR_EID, CFE_EVS_EventType_ERROR,
-                              "L%d TO Can't subscribe to stream 0x%x status %i", __LINE__,
-                              (unsigned int)CFE_SB_MsgIdToValue(SubEntry->Stream), (int)status);
+            status = CFE_SB_SubscribeEx(SubEntry->Stream, TO_LAB_Global.Tlm_pipe, SubEntry->Flags, SubEntry->BufLimit);
+            if (status != CFE_SUCCESS)
+            {
+                CFE_EVS_SendEvent(TO_LAB_SUBSCRIBE_ERR_EID, CFE_EVS_EventType_ERROR,
+                                  "L%d TO Can't subscribe to stream 0x%x status %i", __LINE__,
+                                  (unsigned int)CFE_SB_MsgIdToValue(SubEntry->Stream), (int)status);
+            }
+
+            ++SubEntry;
         }
 
-        ++SubEntry;
+        CFE_EVS_SendEvent(TO_LAB_INIT_INF_EID, CFE_EVS_EventType_INFORMATION,
+                          "TO Lab Initialized.%s, Awaiting enable command.", TO_LAB_VERSION_STRING);
     }
 
     /*
-    ** Install the delete handler
-    */
+     ** Install the delete handler
+     */
     OS_TaskInstallDeleteHandler(&TO_LAB_delete_callback);
 
-    CFE_EVS_SendEvent(TO_LAB_INIT_INF_EID, CFE_EVS_EventType_INFORMATION,
-                      "TO Lab Initialized.%s, Awaiting enable command.", TO_LAB_VERSION_STRING);
-
-    return CFE_SUCCESS;
+    return status;
 }
 
 /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */

diff --git a/fsw/src/to_lab_dispatch.c b/fsw/src/to_lab_dispatch.c
@@ -76,6 +76,7 @@ void TO_LAB_ProcessGroundCommand(const CFE_SB_Buffer_t *SBBufPtr)
                               "L%d TO: Invalid Function Code Rcvd In Ground Command 0x%x", __LINE__,
                               (unsigned int)CommandCode);
             ++TO_LAB_Global.HkTlm.Payload.CommandErrorCounter;
+            break;
     }
 }