LibrePilot/ground/openpilotgcs/src/plugins/setupwizard/pages/esccalibrationpage.cpp

/**
 ******************************************************************************
 *
 * @file       EscCalibrationPage.cpp
 * @author     The OpenPilot Team, http://www.openpilot.org Copyright (C) 2014.
 * @addtogroup
 * @{
 * @addtogroup EscCalibrationPage
 * @{
 * @brief
 *****************************************************************************/
/*
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
 * for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 */


#include "esccalibrationpage.h"
#include "ui_esccalibrationpage.h"
#include "setupwizard.h"
#include "mixersettings.h"
#include "extensionsystem/pluginmanager.h"
#include "uavobjectmanager.h"
#include "vehicleconfigurationhelper.h"

EscCalibrationPage::EscCalibrationPage(SetupWizard *wizard, QWidget *parent) :
    AbstractWizardPage(wizard, parent),
    ui(new Ui::EscCalibrationPage), m_isCalibrating(false)
{
    ui->setupUi(this);
    connect(ui->startStopButton, SIGNAL(clicked()), this, SLOT(startStopButtonClicked()));
}

EscCalibrationPage::~EscCalibrationPage()
{
    delete ui;
}

bool EscCalibrationPage::validatePage()
{
    return true;
}

void EscCalibrationPage::enableButtons(bool enable)
{
    getWizard()->button(QWizard::NextButton)->setEnabled(enable);
    getWizard()->button(QWizard::CancelButton)->setEnabled(enable);
    getWizard()->button(QWizard::BackButton)->setEnabled(enable);
    getWizard()->button(QWizard::CustomButton1)->setEnabled(enable);
    QApplication::processEvents();
}

void EscCalibrationPage::startStopButtonClicked()
{
    if (!m_isCalibrating) {
        m_isCalibrating = true;
        ui->startStopButton->setEnabled(false);
        enableButtons(false);
        ExtensionSystem::PluginManager *pm = ExtensionSystem::PluginManager::instance();
        UAVObjectManager *uavoManager = pm->getObject<UAVObjectManager>();
        Q_ASSERT(uavoManager);
        MixerSettings *mSettings = MixerSettings::GetInstance(uavoManager);
        Q_ASSERT(mSettings);
        QString mixerTypePattern = "Mixer%1Type";
        for (int i = 0; i < 12; i++) {
            UAVObjectField *field = mSettings->getField(mixerTypePattern.arg(i + 1));
            Q_ASSERT(field);
            if (field->getValue().toString() == field->getOptions().at(VehicleConfigurationHelper::MIXER_TYPE_MOTOR)) {
                OutputCalibrationUtil *output = new OutputCalibrationUtil();
                output->startChannelOutput(i, LOW_OUTPUT_VALUE);
                output->setChannelOutputValue(HIGH_OUTPUT_VALUE);
                m_outputs << output;
            }
        }
        ui->startStopButton->setText(tr("Stop"));
        ui->startStopButton->setEnabled(true);
    } else {
        m_isCalibrating = false;
        ui->startStopButton->setEnabled(false);
        foreach(OutputCalibrationUtil * output, m_outputs) {
            output->stopChannelOutput();
            delete output;
        }
        m_outputs.clear();
        m_isCalibrating = false;
        ui->startStopButton->setText("Start");
        ui->startStopButton->setEnabled(true);
        enableButtons(true);
    }
}