コード例 #1
0
ファイル: mavlink.c プロジェクト: night-ghost/inav
void handleMAVLinkTelemetry(timeUs_t currentTimeUs)
{
    if (!mavlinkTelemetryEnabled) {
        return;
    }

    if (!mavlinkPort) {
        return;
    }

    if ((currentTimeUs - lastMavlinkMessage) >= TELEMETRY_MAVLINK_DELAY) {
        processMAVLinkTelemetry(currentTimeUs);
        lastMavlinkMessage = currentTimeUs;
    }
}
コード例 #2
0
ファイル: mavlink.c プロジェクト: tianbin4279/betaflight
void handleMAVLinkTelemetry(void)
{
    if (!mavlinkTelemetryEnabled) {
        return;
    }

    if (!mavlinkPort) {
        return;
    }

    uint32_t now = micros();
    if ((now - lastMavlinkMessage) >= TELEMETRY_MAVLINK_DELAY) {
        processMAVLinkTelemetry();
        lastMavlinkMessage = now;
    }
}