add setupTM

Author: larry-pan

SystemManager/Inc/SystemManager.hpp

@@ -23,6 +23,8 @@ class SystemManager {
         /* Other managers*/
         TelemetryManager *telemetryManager;
 
+        TelemetryManager* setupTM();
+
         /* Class Functions */
         void startSystemManager(); 
 

SystemManager/Src/SystemManager.cpp

@@ -47,7 +47,17 @@ SystemManager::SystemManager()
     // BUT I FEEL LIKE SM PM WOULD KNOW WHERE. MAYBE IN THE HPP FILE? IDK HOW YOU ARE PLANNING ON
     // GATHERING THE DATA. I JUST PUT THEM HERE FOR NOW
 
-    // Struct containing the state of the drone
+   
+    this->telemetryManager = setupTM();
+    this->telemetryManager->init();
+
+    // IDK WHERE SM PLANS TO DO THIS, BUT telemetryManager.update() NEEDS TO BE CALLED AT A SEMI
+    // REGULAR INTERVAL AS IT DEALS WITH MESSAGE DECODING AND LOW PRIORITY DATA TRANSMISSION    
+}
+
+TelemetryManager* SystemManager::setupTM() {
+
+     // Struct containing the state of the drone
     TMStateData stateData;
 
     // values to be assigned to stateData
@@ -106,10 +116,8 @@ SystemManager::SystemManager()
     // the buffer that stores the bytes received from the ground station.
     MavlinkTranslator MT;
 
-    this->telemetryManager = new TelemetryManager(stateData, mavState, mavMode, GSC, MT);
-    this->telemetryManager->init();
-    // IDK WHERE SM PLANS TO DO THIS, BUT telemetryManager.update() NEEDS TO BE CALLED AT A SEMI
-    // REGULAR INTERVAL AS IT DEALS WITH MESSAGE DECODING AND LOW PRIORITY DATA TRANSMISSION
+    
+    return new TelemetryManager(stateData, mavState, mavMode, GSC, MT);
 }
 
 // wrapper functions are needed as FreeRTOS xTaskCreate function does not accept functions that have