Break out of commands to individual functions

src/modules/cmd/cmd.cpp

@@ -92,11 +92,6 @@ cmd::command_id cmd::parse_command_name(const char *input) {
   }
 
   if (strcmp(input, "CFG_RESET") == 0) {
-      #ifdef INFO
-      if (_logger != nullptr) {
-        _logger->info("Resetting config");
-      }
-      #endif
     return CMD_CFG_RESET;
   }
 
@@ -148,9 +143,16 @@ int cmd::dump_track_slot(unsigned short id) {
   return 0;
 }
 
-int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[]) {
-  switch (command) {
-    case CMD_REBOOT:
+int cmd::handle_reboot_command(unsigned short argc) {
+  if (argc != 1) {
+#ifdef ERROR
+    if (_logger != nullptr) {
+      _logger->error("REBOOT expects no arguments");
+    }
+#endif
+    return 1;
+  }
+
 #ifdef INFO
   if (_logger != nullptr) {
     _logger->info("Rebooting");
@@ -160,16 +162,28 @@ int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[])
   wdt_enable(WDTO_15MS);
   while (true) {
   }
+  return 0;
+}
+
+int cmd::handle_dumpcfg_command(unsigned short argc) {
+  if (argc != 1) {
+#ifdef ERROR
+    if (_logger != nullptr) {
+      _logger->error("DUMPCFG expects no arguments");
+    }
+#endif
+    return 1;
+  }
 
-    case CMD_DUMPCFG:
 #ifdef INFO
   if (_logger != nullptr) {
     _logger->dump_config();
   }
 #endif
   return 0;
+}
 
-    case CMD_PUT_TRACK:
+int cmd::handle_track_put_command(unsigned short argc, char *argv[]) {
   if (argc != 7) {
 #ifdef ERROR
     if (_logger != nullptr) {
@@ -178,8 +192,8 @@ int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[])
 #endif
     return 1;
   }
-      track_data new_track;
 
+  track_data new_track;
   if (parse_track_slot_id(argv[1], new_track.id) != 0) {
 #ifdef ERROR
     if (_logger != nullptr) {
@@ -215,11 +229,10 @@ int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[])
 #endif
 
   track_temp_global_write(new_track);
-      router::send(MOD_CFG, TASK_CONFIG_WRITE_TEMP_TRACK);
+  return router::send(MOD_CFG, TASK_CONFIG_WRITE_TEMP_TRACK);
+}
 
-      return 0;
-
-    case CMD_DELETE_TRACK: {
+int cmd::handle_track_delete_command(unsigned short argc, char *argv[]) {
   if (argc != 2) {
 #ifdef ERROR
     if (_logger != nullptr) {
@@ -242,7 +255,7 @@ int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[])
   return router::send(MOD_CFG, TASK_CONFIG_TRACK_DELETE, id);
 }
 
-    case CMD_DUMP_TRACK: {
+int cmd::handle_track_dump_command(unsigned short argc, char *argv[]) {
   if (argc != 2) {
 #ifdef ERROR
     if (_logger != nullptr) {
@@ -265,7 +278,7 @@ int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[])
   return this->dump_track_slot(id);
 }
 
-    case CMD_CFG_RESET:
+int cmd::handle_cfg_reset_command(unsigned short argc) {
   if (argc != 1) {
 #ifdef ERROR
     if (_logger != nullptr) {
@@ -274,15 +287,16 @@ int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[])
 #endif
     return 1;
   }
+
 #ifdef INFO
   if (_logger != nullptr) {
     _logger->info("Resetting config");
   }
 #endif
   return router::send(MOD_CFG, TASK_CONFIG_CFG_RESET);
+}
 
-    case CMD_UNKNOWN:
-    default:
+int cmd::handle_unknown_command(unsigned short argc, char *argv[]) {
 #ifdef ERROR
   if (_logger != nullptr) {
     if (argc > 0 && argv != nullptr && argv[0] != nullptr && argv[0][0] != '\0') {
@@ -294,6 +308,31 @@ int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[])
 #endif
   return 1;
 }
+
+int cmd::dispatch_command(command_id command, unsigned short argc, char *argv[]) {
+  switch (command) {
+    case CMD_REBOOT:
+      return this->handle_reboot_command(argc);
+
+    case CMD_DUMPCFG:
+      return this->handle_dumpcfg_command(argc);
+
+    case CMD_PUT_TRACK:
+      return this->handle_track_put_command(argc, argv);
+
+    case CMD_DELETE_TRACK:
+      return this->handle_track_delete_command(argc, argv);
+
+    case CMD_DUMP_TRACK:
+      return this->handle_track_dump_command(argc, argv);
+
+    case CMD_CFG_RESET:
+      return this->handle_cfg_reset_command(argc);
+
+    case CMD_UNKNOWN:
+    default:
+      return this->handle_unknown_command(argc, argv);
+  }
 }
 
 int cmd::try_parse() {

src/modules/cmd/cmd.h

@@ -41,6 +41,13 @@ private:
   int dispatch_command(command_id command, unsigned short argc, char *argv[]);
   int parse_track_slot_id(const char *id_str, unsigned short &id_out);
   int dump_track_slot(unsigned short id);
+  int handle_reboot_command(unsigned short argc);
+  int handle_dumpcfg_command(unsigned short argc);
+  int handle_track_put_command(unsigned short argc, char *argv[]);
+  int handle_track_delete_command(unsigned short argc, char *argv[]);
+  int handle_track_dump_command(unsigned short argc, char *argv[]);
+  int handle_cfg_reset_command(unsigned short argc);
+  int handle_unknown_command(unsigned short argc, char *argv[]);
 
 public:
   int push(const Task &task) override;