diff --git a/ArduPlane/mode.cpp b/ArduPlane/mode.cpp index d9fec93dff..e4f97acc2c 100644 --- a/ArduPlane/mode.cpp +++ b/ArduPlane/mode.cpp @@ -255,6 +255,9 @@ void Mode::reset_controllers() // reset steering controls plane.steer_state.locked_course = false; plane.steer_state.locked_course_err = 0; + + // reset TECS + plane.TECS_controller.reset(); } bool Mode::is_taking_off() const diff --git a/ArduPlane/mode.h b/ArduPlane/mode.h index c26a1233a8..230b372499 100644 --- a/ArduPlane/mode.h +++ b/ArduPlane/mode.h @@ -81,7 +81,7 @@ public: // returns true if the vehicle can be armed in this mode bool pre_arm_checks(size_t buflen, char *buffer) const; - // Reset rate and steering controllers + // Reset rate and steering and TECS controllers void reset_controllers(); //