mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 11:06:04 +08:00
px4iofirmware: return failure when FORCE_SAFETY_OFF fails
This commit is contained in:
committed by
Lorenz Meier
parent
9f3401d12c
commit
d5dfb17f0d
@@ -648,6 +648,9 @@ registers_set_one(uint8_t page, uint8_t offset, uint16_t value)
|
|||||||
case PX4IO_P_SETUP_FORCE_SAFETY_ON:
|
case PX4IO_P_SETUP_FORCE_SAFETY_ON:
|
||||||
if (value == PX4IO_FORCE_SAFETY_MAGIC) {
|
if (value == PX4IO_FORCE_SAFETY_MAGIC) {
|
||||||
r_status_flags &= ~PX4IO_P_STATUS_FLAGS_SAFETY_OFF;
|
r_status_flags &= ~PX4IO_P_STATUS_FLAGS_SAFETY_OFF;
|
||||||
|
|
||||||
|
} else {
|
||||||
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
break;
|
break;
|
||||||
@@ -655,6 +658,9 @@ registers_set_one(uint8_t page, uint8_t offset, uint16_t value)
|
|||||||
case PX4IO_P_SETUP_FORCE_SAFETY_OFF:
|
case PX4IO_P_SETUP_FORCE_SAFETY_OFF:
|
||||||
if (value == PX4IO_FORCE_SAFETY_MAGIC) {
|
if (value == PX4IO_FORCE_SAFETY_MAGIC) {
|
||||||
r_status_flags |= PX4IO_P_STATUS_FLAGS_SAFETY_OFF;
|
r_status_flags |= PX4IO_P_STATUS_FLAGS_SAFETY_OFF;
|
||||||
|
|
||||||
|
} else {
|
||||||
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
break;
|
break;
|
||||||
|
|||||||
Reference in New Issue
Block a user