Skip to content
Snippets Groups Projects
Commit f81a1aed authored by Daniel Agar's avatar Daniel Agar
Browse files

commander state machine add global position check

parent 729c98d9
No related branches found
No related tags found
No related merge requests found
......@@ -1018,18 +1018,36 @@ bool prearm_check(orb_advert_t *mavlink_log_pub, const vehicle_status_flags_s &s
}
}
// mission required
if ((arm_requirements & ARM_REQ_MISSION_BIT)
&& (!status_flags.condition_auto_mission_available || !status_flags.condition_global_position_valid)) {
// Arm Requirements: mission
if (arm_requirements & ARM_REQ_MISSION_BIT) {
if (!status_flags.condition_auto_mission_available) {
prearm_ok = false;
if (reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: valid mission required");
}
}
if (!status_flags.condition_global_position_valid) {
prearm_ok = false;
if (reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: global position required");
}
}
}
// Arm Requirements: global position
if ((arm_requirements & ARM_REQ_GPS_BIT) && (!status_flags.condition_global_position_valid)) {
prearm_ok = false;
if (reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: valid mission required");
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: global position required");
}
}
// arm authorization check
// Arm Requirements: authorization
if (arm_requirements & ARM_REQ_ARM_AUTH_BIT) {
if (arm_auth_check() != vehicle_command_ack_s::VEHICLE_RESULT_ACCEPTED) {
// feedback provided in arm_auth_check
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment