SensorsComponent.cc 2.78 KB
Newer Older
1 2 3 4 5 6 7 8 9
/****************************************************************************
 *
 *   (c) 2009-2016 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 *
 * QGroundControl is licensed according to the terms in the file
 * COPYING.md in the root of the source code directory.
 *
 ****************************************************************************/

10 11 12 13 14

/// @file
///     @author Don Gagne <don@thegagnes.com>

#include "SensorsComponent.h"
Don Gagne's avatar
Don Gagne committed
15
#include "PX4AutoPilotPlugin.h"
Don Gagne's avatar
Don Gagne committed
16 17
#include "QGCQmlWidgetHolder.h"
#include "SensorsComponentController.h"
18

19
const char* SensorsComponent::_airspeedBreaker = "CBRK_AIRSPD_CHK";
20

21
SensorsComponent::SensorsComponent(Vehicle* vehicle, AutoPilotPlugin* autopilot, QObject* parent) :
22
    VehicleComponent(vehicle, autopilot, parent),
23 24
    _name(tr("Sensors"))
{
Don Gagne's avatar
Don Gagne committed
25

26 27 28 29 30 31 32 33 34 35 36 37 38
}

QString SensorsComponent::name(void) const
{
    return _name;
}

QString SensorsComponent::description(void) const
{
    return tr("The Sensors Component allows you to calibrate the sensors within your vehicle. "
              "Prior to flight you must calibrate the Magnetometer, Gyroscope and Accelerometer.");
}

39
QString SensorsComponent::iconResource(void) const
40
{
41
    return "/qmlimages/SensorsComponentIcon.png";
42 43 44 45 46 47 48 49 50
}

bool SensorsComponent::requiresSetup(void) const
{
    return true;
}

bool SensorsComponent::setupComplete(void) const
{
51
    foreach(const QString &triggerParam, setupCompleteChangedTriggerList()) {
52
        if (triggerParam != _airspeedBreaker && _autopilot->getParameterFact(FactSystem::defaultComponentId, triggerParam)->rawValue().toFloat() == 0.0f) {
53 54 55 56 57 58 59
            return false;
        }
    }

    return true;
}

Don Gagne's avatar
Don Gagne committed
60
QStringList SensorsComponent::setupCompleteChangedTriggerList(void) const
61
{
Don Gagne's avatar
Don Gagne committed
62 63
    QStringList triggers;
    
64
    triggers << "CAL_MAG0_ID" << "CAL_GYRO0_ID" << "CAL_ACC0_ID" << "CBRK_AIRSPD_CHK";
Don Gagne's avatar
Don Gagne committed
65
    if ((_vehicle->fixedWing() || _vehicle->vtol()) && _autopilot->getParameterFact(FactSystem::defaultComponentId, _airspeedBreaker)->rawValue().toInt() != 162128) {
66
        triggers << "SENS_DPRES_OFF";
Don Gagne's avatar
Don Gagne committed
67 68 69
    }
    
    return triggers;
70 71
}

72
QUrl SensorsComponent::setupSource(void) const
73
{
74
    return QUrl::fromUserInput("qrc:/qml/SensorsComponent.qml");
75 76
}

77
QUrl SensorsComponent::summaryQmlSource(void) const
78
{
79 80
    QString summaryQml;
    
Don Gagne's avatar
Don Gagne committed
81 82 83 84
    if (_vehicle->fixedWing() || _vehicle->vtol()) {
        summaryQml = "qrc:/qml/SensorsComponentSummaryFixedWing.qml";
    } else {
        summaryQml = "qrc:/qml/SensorsComponentSummary.qml";
85 86 87
    }
    
    return QUrl::fromUserInput(summaryQml);
88
}
Don Gagne's avatar
Don Gagne committed
89 90 91 92 93 94 95 96 97 98 99 100

QString SensorsComponent::prerequisiteSetup(void) const
{
    PX4AutoPilotPlugin* plugin = dynamic_cast<PX4AutoPilotPlugin*>(_autopilot);
    Q_ASSERT(plugin);
    
    if (!plugin->airframeComponent()->setupComplete()) {
        return plugin->airframeComponent()->name();
    }
    
    return QString();
}