Fixes #4478 (#4577)

2017-03-08 22:03:53 +01:00
parent 03b65b06b6
commit 0c37e04bfc
2 changed files with 16 additions and 4 deletions
@@ -99,7 +99,6 @@ void telemetryWakeup()
   if (telemetryProtocol != requiredTelemetryProtocol) {
 #endif
    telemetryInit(requiredTelemetryProtocol);
-    telemetryProtocol = requiredTelemetryProtocol;
  }
 #endif

@@ -414,6 +413,8 @@ void telemetryReset()
 // we don't reset the telemetry here as we would also reset the consumption after model load
 void telemetryInit(uint8_t protocol)
 {
+  telemetryProtocol = protocol;
+
  if (protocol == PROTOCOL_FRSKY_D) {
    telemetryPortInit(FRSKY_D_BAUDRATE, TELEMETRY_SERIAL_DEFAULT);
  }