diff --git a/src/FollowMe/FollowMe.cc b/src/FollowMe/FollowMe.cc index b75df95..a697f1c 100644 --- a/src/FollowMe/FollowMe.cc +++ b/src/FollowMe/FollowMe.cc @@ -151,7 +151,7 @@ void FollowMe::_sendGCSMotionReport() for (int i=0; icount(); i++) { Vehicle* vehicle = vehicles->value(i); - if (_isFollowFlightMode(vehicle, vehicle->flightMode())) { + if (_currentMode == MODE_ALWAYS || _isFollowFlightMode(vehicle, vehicle->flightMode())) { qCDebug(FollowMeLog) << "sendGCSMotionReport latInt:lonInt:altMetersAMSL" << motionReport.lat_int << motionReport.lon_int << motionReport.altMetersAMSL; vehicle->firmwarePlugin()->sendGCSMotionReport(vehicle, motionReport, estimatation_capabilities); }