Initial telemetry implementation

src/main.cpp

@@ -15,6 +15,7 @@
 #include "base/router.h"
 #include "modules/battery/battery.h"
 #include "modules/thermocouple/thermocouple.h"
+#include "modules/telemetry/telemetry.h"
 
 
 SystemLogger *logger = new SystemLogger(&Serial);
@@ -25,6 +26,7 @@ Config *system_config = new Config(logger);
 Cmd *command_handler = new Cmd(&Serial, logger);
 Battery *battery_module = new Battery(logger);
 Thermocouple *thermocouple_module = new Thermocouple(logger);
+Telemetry *telemetry_module = new Telemetry(&Serial1, logger);
 
 
 
@@ -37,39 +39,46 @@ void setup() {
   module_registry[module::Cmd] = command_handler;
   module_registry[module::Battery] = battery_module;
   module_registry[module::Thermocouple] = thermocouple_module;
+  module_registry[module::Telemetry] = telemetry_module;
 
   display->init();
   display->printMessage("Starting Initialization");
-  delay(1000);
+  delay(750);
 
   display->printMessage("Cmd Init...");
   command_handler->init();
-  delay(1000);
+  delay(750);
   display->printMessage("Cmd Init Complete");
-  delay(1000);
+  delay(750);
 
   display->printMessage("Config Init...");
   int result = system_config->autoInit();
-  delay(1000);
+  delay(750);
   if (result != 0) {
     display->printMessage("Configuration Read Failed");
   } else {
     display->printMessage("Config Init Complete");
   }
-  delay(1000);
+  delay(750);
 
   display->printMessage("GPS Init...");
   gps_module->init();
-  delay(1000);
+  delay(750);
   display->printMessage("GPS Init Complete");
-  delay(1000);
+  delay(750);
 
   display->printMessage("Sensors Init...");
   battery_module->init();
   thermocouple_module->init();
-  delay(1000);
+  delay(750);
   display->printMessage("Sensors Init Complete");
-  delay(1000);
+  delay(750);
+
+  display->printMessage("Telemetry Init...");
+  telemetry_module->init();
+  delay(750);
+  display->printMessage("Telemetry Init Complete");
+  delay(750);
   router::send(module::Lcd, task::DisplayDriverPrimary);
 }
 
@@ -80,4 +89,5 @@ void loop() {
   system_config->loop();
   battery_module->loop();
   thermocouple_module->loop();
+  telemetry_module->loop();
 }