msp: also reboot on MSP_REBOOT_BOOTLOADER_FLASH

BossHobby · Aug 8, 2024 · e912b8c · e912b8c
1 parent 2e3e09d
commit e912b8c
Showing 1 changed file with 5 additions and 0 deletions.
diff --git a/src/io/msp.c b/src/io/msp.c
@@ -518,14 +518,19 @@ static void msp_process_serial_cmd(msp_t *msp, msp_magic_t magic, uint16_t cmd,
 
   case MSP_REBOOT: {
     if (flags.arm_state) {
+      msp_send_error(msp, magic, cmd);
       break;
     }
 
+    msp_send_reply(msp, magic, cmd, payload, 1);
+    time_delay_ms(100);
+
     switch (payload[0]) {
     case MSP_REBOOT_FIRMWARE:
       system_reset();
       break;
 
+    case MSP_REBOOT_BOOTLOADER_FLASH:
     case MSP_REBOOT_BOOTLOADER_ROM:
       system_reset_to_bootloader();
       break;