Enable directly injecting motor failures using e.g. failure motor off -i 1

Only if SYS_FAILURE_EN is enabled and CA_FAILURE_MODE is > 0.
This commit is contained in:
Matthias Grob
2025-08-28 16:14:51 +02:00
parent 786e0a12c2
commit e59afce5db
8 changed files with 44 additions and 4 deletions
+1
View File
@@ -1956,6 +1956,7 @@ void Commander::run()
fd_status.fd_motor = _failure_detector.getStatusFlags().motor;
fd_status.imbalanced_prop_metric = _failure_detector.getImbalancedPropMetric();
fd_status.motor_failure_mask = _failure_detector.getMotorFailures();
fd_status.motor_stop_mask = _failure_detector.getMotorStopMask();
fd_status.timestamp = hrt_absolute_time();
_failure_detector_status_pub.publish(fd_status);
}