Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-01 02:55:07 +08:00
Code Issues Actions 19 Packages Projects Releases Wiki Activity

add 500 ms to loadWait call

Browse Source
This commit is contained in:
jonas
2026-04-10 13:50:09 +02:00
parent fd45f4e459
commit 2960e5eda3
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/rtl.cpp
+3 -3
View File
@@ -716,7 +716,7 @@ bool RTL::findAssociatedSafePointIndex(const PositionYawSetpoint &rtl_position,
mission_item_s mission_item{}; mission_item_s mission_item{};
const bool success = _dataman_cache_safepoint.loadWait(static_cast<dm_item_t>(_stats.dataman_id), current_seq, const bool success = _dataman_cache_safepoint.loadWait(static_cast<dm_item_t>(_stats.dataman_id), current_seq,
reinterpret_cast<uint8_t *>(&mission_item), sizeof(mission_item_s)); reinterpret_cast<uint8_t *>(&mission_item), sizeof(mission_item_s), 500_ms);
if (!success) { if (!success) {
PX4_ERR("dm_read failed"); 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 // Skip invalid rally points so later valid rally points are considered
if (!extractValidSafePointPosition(mission_item, home_altitude_amsl, safe_point_position)) { 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, 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{}; mission_item_s mission_item{};
const bool success = _dataman_cache_safepoint.loadWait(static_cast<dm_item_t>(_stats.dataman_id), current_seq, const bool success = _dataman_cache_safepoint.loadWait(static_cast<dm_item_t>(_stats.dataman_id), current_seq,
reinterpret_cast<uint8_t *>(&mission_item), sizeof(mission_item_s)); reinterpret_cast<uint8_t *>(&mission_item), sizeof(mission_item_s), 500_ms);
if (!success) { if (!success) {
PX4_ERR("dm_read failed"); PX4_ERR("dm_read failed");