diff --git a/src/main.cpp b/src/main.cpp index 06c5844..150fb86 100644 --- a/src/main.cpp +++ b/src/main.cpp @@ -1,27 +1,31 @@ #include "flags.h" +#include "modules/cmd/cmd.h" #include "modules/config/config.h" #include "modules/gps/gps.h" #include "modules/lcd/lcd.h" #include "modules/logger/system_logger.h" #include +#include system_logger *logger_output = new system_logger(&Serial); lcd *driver_display = new lcd(logger_output); gps *gps_module = new gps(&Serial2, logger_output); config *system_config = new config(logger_output); +cmd *command_handler = new cmd(&Serial, logger_output); void setup() { + wdt_disable(); driver_display->init(); driver_display->set_gps(gps_module); driver_display->print_message("Starting Initialization"); delay(1000); - driver_display->print_message("Serial Init..."); - Serial.begin(115200); + driver_display->print_message("Cmd Init..."); + command_handler->init(); delay(1000); - driver_display->print_message("Serial Init Complete"); + driver_display->print_message("Cmd Init Complete"); delay(1000); driver_display->print_message("Config Init..."); @@ -41,6 +45,8 @@ void setup() { driver_display->switch_screen(screen::gps_debug); } -void loop() { gps_module->parse_task(500); -driver_display->render_task(); +void loop() { + gps_module->parse_task(500); + driver_display->render_task(); + command_handler->parse_task(500); }