px4iofirmware: return failure when FORCE_SAFETY_OFF fails

This commit is contained in:
Jonathan Challinger
2015-04-06 18:22:32 -07:00
committed by Lorenz Meier
parent 9f3401d12c
commit d5dfb17f0d
+6
View File
@@ -648,6 +648,9 @@ registers_set_one(uint8_t page, uint8_t offset, uint16_t value)
case PX4IO_P_SETUP_FORCE_SAFETY_ON:
if (value == PX4IO_FORCE_SAFETY_MAGIC) {
r_status_flags &= ~PX4IO_P_STATUS_FLAGS_SAFETY_OFF;
} else {
return -1;
}
break;
@@ -655,6 +658,9 @@ registers_set_one(uint8_t page, uint8_t offset, uint16_t value)
case PX4IO_P_SETUP_FORCE_SAFETY_OFF:
if (value == PX4IO_FORCE_SAFETY_MAGIC) {
r_status_flags |= PX4IO_P_STATUS_FLAGS_SAFETY_OFF;
} else {
return -1;
}
break;