mavlink: set current WP working as expected, report current WP with 0.5 Hz

This commit is contained in:
Julian Oes
2014-02-24 15:17:13 +01:00
parent 9c5894239f
commit 926c4701c7
4 changed files with 16 additions and 15 deletions
+1 -1
View File
@@ -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;
+3 -5
View File
@@ -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
+1 -1
View File
@@ -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: