|
|
|
@ -201,19 +201,11 @@ Mission::update_offboard_mission()
@@ -201,19 +201,11 @@ Mission::update_offboard_mission()
|
|
|
|
|
|
|
|
|
|
/* Check mission feasibility, for now do not handle the return value,
|
|
|
|
|
* however warnings are issued to the gcs via mavlink from inside the MissionFeasiblityChecker */ |
|
|
|
|
dm_item_t dm_current; |
|
|
|
|
dm_item_t dm_current = DM_KEY_WAYPOINTS_OFFBOARD(_transfer_dataman_id); |
|
|
|
|
|
|
|
|
|
if (_offboard_mission.dataman_id == 0) { |
|
|
|
|
dm_current = DM_KEY_WAYPOINTS_OFFBOARD_0; |
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
dm_current = DM_KEY_WAYPOINTS_OFFBOARD_1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
missionFeasiblityChecker.checkMissionFeasible(_navigator->get_vstatus()->is_rotary_wing, dm_current, |
|
|
|
|
(size_t)_offboard_mission.count, |
|
|
|
|
_navigator->get_geofence(), |
|
|
|
|
_navigator->get_home_position()->alt); |
|
|
|
|
missionFeasiblityChecker.checkMissionFeasible(_navigator->get_vstatus()->is_rotary_wing, |
|
|
|
|
dm_current, (size_t) _offboard_mission.count, _navigator->get_geofence(), |
|
|
|
|
_navigator->get_home_position()->alt); |
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
warnx("offboard mission update failed"); |
|
|
|
@ -474,12 +466,7 @@ Mission::read_mission_item(bool onboard, bool is_current, struct mission_item_s
@@ -474,12 +466,7 @@ Mission::read_mission_item(bool onboard, bool is_current, struct mission_item_s
|
|
|
|
|
|
|
|
|
|
mission = &_offboard_mission; |
|
|
|
|
|
|
|
|
|
if (_offboard_mission.dataman_id == 0) { |
|
|
|
|
dm_item = DM_KEY_WAYPOINTS_OFFBOARD_0; |
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
dm_item = DM_KEY_WAYPOINTS_OFFBOARD_1; |
|
|
|
|
} |
|
|
|
|
dm_item = DM_KEY_WAYPOINTS_OFFBOARD(_offboard_mission.dataman_id); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (*mission_index_ptr < 0 || *mission_index_ptr >= (int)mission->count) { |
|
|
|
|