Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 00:28:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

Rover: fix failsafe throttle

Browse Source
This commit is contained in:
Pierre Kancir 2017-07-06 14:50:17 +09:00 committed by Randy Mackay
parent 9b97ad0fc0
commit ba8664193a
1 changed files with 7 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
APMrover2/Steering.cpp
View File

@ -243,10 +243,14 @@ void Rover::calc_nav_steer() {
*****************************************/
void Rover::set_servos(void) {
// Apply slew rate limit on non Manual modes
if (control_mode != MANUAL && control_mode != LEARNING) {
g2.motors.slew_limit_throttle(true);
} else {
if (control_mode == MANUAL || control_mode == LEARNING) {
g2.motors.slew_limit_throttle(false);
if (failsafe.bits & FAILSAFE_EVENT_THROTTLE) {
g2.motors.set_throttle(0.0f);
g2.motors.set_steering(0.0f);
}
} else {
g2.motors.slew_limit_throttle(true);
}
// send output signals to motors