void checkMAVLinkTelemetryState(void) { bool newTelemetryEnabledValue = telemetryDetermineEnabledState(mavlinkPortSharing); if (newTelemetryEnabledValue == mavlinkTelemetryEnabled) { return; } if (newTelemetryEnabledValue) configureMAVLinkTelemetryPort(); else freeMAVLinkTelemetryPort(); }
void checkMAVLinkTelemetryState(void) { if (portConfig && telemetryCheckRxPortShared(portConfig)) { if (!mavlinkTelemetryEnabled && telemetrySharedPort != NULL) { mavlinkPort = telemetrySharedPort; mavlinkTelemetryEnabled = true; } } else { bool newTelemetryEnabledValue = telemetryDetermineEnabledState(mavlinkPortSharing); if (newTelemetryEnabledValue == mavlinkTelemetryEnabled) { return; } if (newTelemetryEnabledValue) configureMAVLinkTelemetryPort(); else freeMAVLinkTelemetryPort(); } }