Copter: add cork-push to esc calibration

Also remove unnecessary duplicate call to motors::set_throttle_passthrough_for_esc_calibration
This commit is contained in:
Randy Mackay 2018-06-13 11:13:55 +09:00
parent 41767e0458
commit 2af8e673cc

View File

@ -184,17 +184,18 @@ void Copter::esc_calibration_auto()
// delay for 5 seconds while outputting pulses
uint32_t tstart = millis();
while (millis() - tstart < 5000) {
SRV_Channels::cork();
motors->set_throttle_passthrough_for_esc_calibration(1.0f);
SRV_Channels::push();
esc_calibration_notify();
delay(3);
}
// reduce throttle to minimum
motors->set_throttle_passthrough_for_esc_calibration(0.0f);
// block until we restart
while(1) {
SRV_Channels::cork();
motors->set_throttle_passthrough_for_esc_calibration(0.0f);
SRV_Channels::push();
esc_calibration_notify();
delay(3);
}