diff --git a/radio/src/io/frsky_firmware_update.cpp b/radio/src/io/frsky_firmware_update.cpp index b976528b0..f1460e6cc 100644 --- a/radio/src/io/frsky_firmware_update.cpp +++ b/radio/src/io/frsky_firmware_update.cpp @@ -121,13 +121,14 @@ void FrskyDeviceFirmwareUpdate::startup() bool FrskyDeviceFirmwareUpdate::readBuffer(uint8_t * buffer, uint8_t count, uint32_t timeout) { uint32_t elapsed = 0; - uint8_t index = 0; watchdogSuspend(timeout); switch(module) { #if defined(INTMODULE_USART) case INTERNAL_MODULE: + { + uint8_t index = 0; while (index < count && elapsed < timeout) { if (intmoduleFifo.pop(buffer[index])) { ++index; @@ -139,6 +140,7 @@ bool FrskyDeviceFirmwareUpdate::readBuffer(uint8_t * buffer, uint8_t count, uint } } break; + } #endif default: