diff --git a/ArduSub/motors.cpp b/ArduSub/motors.cpp index 7bfe51c249..504c6651d9 100644 --- a/ArduSub/motors.cpp +++ b/ArduSub/motors.cpp @@ -18,11 +18,12 @@ void Sub::motors_output() verify_motor_test(); } else { motors.set_interlock(true); - SRV_Channels::cork(); + auto &srv = AP::srv(); + srv.cork(); SRV_Channels::calc_pwm(); SRV_Channels::output_ch_all(); motors.output(); - AP::srv().push(); + srv.push(); } }