diff --git a/src/modules/navigator/rtl.cpp b/src/modules/navigator/rtl.cpp index aead430645..c9b9ae109e 100644 --- a/src/modules/navigator/rtl.cpp +++ b/src/modules/navigator/rtl.cpp @@ -716,7 +716,7 @@ bool RTL::findAssociatedSafePointIndex(const PositionYawSetpoint &rtl_position, mission_item_s mission_item{}; const bool success = _dataman_cache_safepoint.loadWait(static_cast(_stats.dataman_id), current_seq, - reinterpret_cast(&mission_item), sizeof(mission_item_s)); + reinterpret_cast(&mission_item), sizeof(mission_item_s), 500_ms); if (!success) { PX4_ERR("dm_read failed"); @@ -731,7 +731,7 @@ bool RTL::findAssociatedSafePointIndex(const PositionYawSetpoint &rtl_position, // Skip invalid rally points so later valid rally points are considered if (!extractValidSafePointPosition(mission_item, home_altitude_amsl, safe_point_position)) { - continue;; + continue; } const float dist_to_safepoint = get_distance_to_next_waypoint(safe_point_position.lat, safe_point_position.lon, @@ -756,7 +756,7 @@ bool RTL::scanVtolLandApproachBlock(int safe_point_index, float home_altitude_am mission_item_s mission_item{}; const bool success = _dataman_cache_safepoint.loadWait(static_cast(_stats.dataman_id), current_seq, - reinterpret_cast(&mission_item), sizeof(mission_item_s)); + reinterpret_cast(&mission_item), sizeof(mission_item_s), 500_ms); if (!success) { PX4_ERR("dm_read failed");