mixer scheduler

2020-12-09 07:24:27 +01:00
parent 17feb48d9d
commit 02660c763a
32 changed files with 644 additions and 314 deletions
@@ -184,6 +184,26 @@ void processCrossfireTelemetryFrame()
      break;
    }

+    case RADIO_ID:
+      if (telemetryRxBuffer[3] == 0xEA    // radio address
+          && telemetryRxBuffer[5] == 0x10 // timing correction frame
+          ) {
+
+        uint32_t update_interval;
+        int32_t  offset;
+        if (getCrossfireTelemetryValue<4>(6, (int32_t&)update_interval) && getCrossfireTelemetryValue<4>(10, offset)) {
+
+          // values are in 10th of micro-seconds
+          update_interval /= 10;
+          offset /= 10;
+
+          TRACE("[XF] Rate: %d, Lag: %d", update_interval, offset);
+          getModuleSyncStatus(EXTERNAL_MODULE).update(update_interval, offset + SAFE_SYNC_LAG);
+        }
+      }
+      break;
+
+
 #if defined(LUA)
    default:
      if (luaInputTelemetryFifo && luaInputTelemetryFifo->hasSpace(telemetryRxBufferCount-2) ) {