fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-23 05:03:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

mavlink: waypoint manager fixes, mission saving on reboot

Browse Source
This commit is contained in:
Anton Babushkin
2014-06-09 16:10:24 +02:00
parent 4ad435b483
commit cad0877f67
4 changed files with 233 additions and 234 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/navigator_main.cpp
+2 -4
View File
@@ -603,14 +603,12 @@ Navigator::task_main()
warnx("Could not clear geofence");
}
#if 0 // *** UNTESTED... Anton, this is for you
/* Get the last offboard mission id */
persistent_system_state_t sys_state;
if (dm_read(DM_KEY_SYSTEM_STATE, 0, &sys_state, sizeof(sys_state)) == sizeof(sys_state)) {
if ((sys_state.current_offboard_waypoint_id >= 0) && (sys_state.current_offboard_waypoint_id <= 1))
_mission.set_offboard_dataman_id(sys_state.current_offboard_waypoint_id);
if ((sys_state.offboard_waypoint_id >= 0) && (sys_state.offboard_waypoint_id <= 1))
_mission.set_offboard_dataman_id(sys_state.offboard_waypoint_id);
}
#endif
/*
* do subscriptions