diff --git a/src/FollowMe/FollowMe.cc b/src/FollowMe/FollowMe.cc index b75df953af6230ee55a3e02f460094c42711ce51..a697f1c108fcf4be3c79d93299af9d2434f35683 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); }