Add jump to slave bootloader command.

2017-10-12 19:57:41 +02:00
parent d2fd7bc613
commit ef34094004
4 changed files with 36 additions and 1 deletions
--- a/right/src/usb_protocol_handler.c
+++ b/right/src/usb_protocol_handler.c
@@ -265,6 +265,18 @@ void getDebugInfo(void)
    GenericHidOutBuffer[8] = (ticks >> 56) & 0xff;
 */}

+void jumpToSlaveBootloader(void)
+{
+    uint8_t uhkModuleDriverId = GenericHidInBuffer[1];
+
+    if (uhkModuleDriverId >= UHK_MODULE_MAX_COUNT) {
+        setError(JumpToBootloaderError_InvalidModuleDriverId);
+        return;
+    }
+
+    UhkModuleStates[uhkModuleDriverId].jumpToBootloader = true;
+}
+
 // The main protocol handler function

 void UsbProtocolHandler(void)
@@ -316,6 +328,9 @@ void UsbProtocolHandler(void)
        case UsbCommand_GetDebugInfo:
            getDebugInfo();
            break;
+        case UsbCommand_JumpToSlaveBootloader:
+            jumpToSlaveBootloader();
+            break;
        default:
            break;
    }