1
0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-02-20 10:54:14 +01:00

OP-1718 Set all servos outputs to 1500 before plug battery for Esc calibration (Tricopter)

This commit is contained in:
Laurent Lalanne 2015-02-15 20:51:49 +01:00
parent c645738bc5
commit b6937764aa

View File

@ -104,6 +104,16 @@ void EscCalibrationPage::startButtonClicked()
QString mixerTypePattern = "Mixer%1Type";
OutputCalibrationUtil::startOutputCalibration();
// First check if any servo and set his value to 1500 (like Tricopter)
for (quint32 i = 0; i < ActuatorSettings::CHANNELADDR_NUMELEM; i++) {
UAVObjectField *field = mSettings->getField(mixerTypePattern.arg(i + 1));
Q_ASSERT(field);
if (field->getValue().toString() == field->getOptions().at(VehicleConfigurationHelper::MIXER_TYPE_SERVO)) {
m_outputUtil.startChannelOutput(i, 1500);
m_outputUtil.stopChannelOutput();
}
}
// Find motors and start Esc procedure
for (quint32 i = 0; i < ActuatorSettings::CHANNELADDR_NUMELEM; i++) {
UAVObjectField *field = mSettings->getField(mixerTypePattern.arg(i + 1));
Q_ASSERT(field);