mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 11:23:33 +08:00
mavlink: set current WP working as expected, report current WP with 0.5 Hz
This commit is contained in:
@@ -1105,7 +1105,7 @@ Navigator::set_mission_item()
|
||||
|
||||
if (ret == OK) {
|
||||
|
||||
_mission.report_current_mission_item();
|
||||
_mission.report_current_offboard_mission_item();
|
||||
|
||||
/* reset time counter for new item */
|
||||
_time_first_inside_orbit = 0;
|
||||
|
||||
@@ -89,7 +89,7 @@ Mission::set_current_offboard_mission_index(int new_index)
|
||||
_current_offboard_mission_index = 0;
|
||||
}
|
||||
}
|
||||
report_current_mission_item();
|
||||
report_current_offboard_mission_item();
|
||||
}
|
||||
|
||||
void
|
||||
@@ -296,11 +296,9 @@ Mission::report_mission_item_reached()
|
||||
}
|
||||
|
||||
void
|
||||
Mission::report_current_mission_item()
|
||||
Mission::report_current_offboard_mission_item()
|
||||
{
|
||||
if (_current_mission_type == MISSION_TYPE_OFFBOARD) {
|
||||
_mission_result.index_current_mission = _current_offboard_mission_index;
|
||||
}
|
||||
_mission_result.index_current_mission = _current_offboard_mission_index;
|
||||
}
|
||||
|
||||
void
|
||||
|
||||
@@ -73,7 +73,7 @@ public:
|
||||
void move_to_next();
|
||||
|
||||
void report_mission_item_reached();
|
||||
void report_current_mission_item();
|
||||
void report_current_offboard_mission_item();
|
||||
void publish_mission_result();
|
||||
|
||||
private:
|
||||
|
||||
Reference in New Issue
Block a user