rate controller failure detector at takeoff

This commit is contained in:
Daniel Agar
2020-12-13 20:45:48 -05:00
parent e51000c5be
commit 6c5af97868
12 changed files with 121 additions and 55 deletions
+2 -1
View File
@@ -1,6 +1,7 @@
uint64 timestamp # time since system start (microseconds)
uint32 armed_time_ms # Arming timestamp
uint64 armed_time # Arming timestamp
bool armed # Set to true if system is armed
bool prearmed # Set to true if the actuator safety is disabled but motors are not armed
bool ready_to_arm # Set to true if system is ready to be armed
+3
View File
@@ -5,3 +5,6 @@ float32 rollspeed_integ
float32 pitchspeed_integ
float32 yawspeed_integ
float32 additional_integ1 # FW: wheel rate integrator (optional)
float32[3] error # rate error [radians/s]
float32[3] error_integrated # rate error integrated [radians]
+7 -6
View File
@@ -11,12 +11,13 @@ uint8 ARMING_STATE_IN_AIR_RESTORE = 5
uint8 ARMING_STATE_MAX = 6
# FailureDetector status
uint8 FAILURE_NONE = 0
uint8 FAILURE_ROLL = 1 # (1 << 0)
uint8 FAILURE_PITCH = 2 # (1 << 1)
uint8 FAILURE_ALT = 4 # (1 << 2)
uint8 FAILURE_EXT = 8 # (1 << 3)
uint8 FAILURE_ARM_ESC = 16 # (1 << 4)
uint8 FAILURE_NONE = 0
uint8 FAILURE_ROLL = 1 # (1 << 0)
uint8 FAILURE_PITCH = 2 # (1 << 1)
uint8 FAILURE_ALT = 4 # (1 << 2)
uint8 FAILURE_EXT = 8 # (1 << 3)
uint8 FAILURE_ARM_ESC = 16 # (1 << 4)
uint8 FAILURE_RATE_CTRL = 32 # (1 << 5)
# HIL
uint8 HIL_STATE_OFF = 0