SensorsComponent.cc 3.67 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27
/*=====================================================================
 
 QGroundControl Open Source Ground Control Station
 
 (c) 2009 - 2014 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 
 This file is part of the QGROUNDCONTROL project
 
 QGROUNDCONTROL 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.
 
 QGROUNDCONTROL 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 QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.
 
 ======================================================================*/

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

#include "SensorsComponent.h"
Don Gagne's avatar
Don Gagne committed
28
#include "PX4AutoPilotPlugin.h"
Don Gagne's avatar
Don Gagne committed
29 30
#include "QGCQmlWidgetHolder.h"
#include "SensorsComponentController.h"
31 32 33

// These two list must be kept in sync

34 35
SensorsComponent::SensorsComponent(Vehicle* vehicle, AutoPilotPlugin* autopilot, QObject* parent) :
    PX4Component(vehicle, autopilot, parent),
36 37
    _name(tr("Sensors"))
{
Don Gagne's avatar
Don Gagne committed
38

39 40 41 42 43 44 45 46 47 48 49 50 51
}

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.");
}

52
QString SensorsComponent::iconResource(void) const
53
{
54
    return "/qmlimages/SensorsComponentIcon.png";
55 56 57 58 59 60 61 62 63
}

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

bool SensorsComponent::setupComplete(void) const
{
64
    foreach(const QString &triggerParam, setupCompleteChangedTriggerList()) {
Don Gagne's avatar
Don Gagne committed
65
        if (_autopilot->getParameterFact(FactSystem::defaultComponentId, triggerParam)->rawValue().toFloat() == 0.0f) {
66 67 68 69 70 71 72
            return false;
        }
    }

    return true;
}

Don Gagne's avatar
Don Gagne committed
73
QStringList SensorsComponent::setupCompleteChangedTriggerList(void) const
74
{
Don Gagne's avatar
Don Gagne committed
75 76 77
    QStringList triggers;
    
    triggers << "CAL_MAG0_ID" << "CAL_GYRO0_ID" << "CAL_ACC0_ID";
78 79 80 81 82
    switch (_vehicle->vehicleType()) {
        case MAV_TYPE_FIXED_WING:
        case MAV_TYPE_VTOL_DUOROTOR:
        case MAV_TYPE_VTOL_QUADROTOR:
        case MAV_TYPE_VTOL_TILTROTOR:
83 84 85 86
        case MAV_TYPE_VTOL_RESERVED2:
        case MAV_TYPE_VTOL_RESERVED3:
        case MAV_TYPE_VTOL_RESERVED4:
        case MAV_TYPE_VTOL_RESERVED5:
87 88 89 90
            triggers << "SENS_DPRES_OFF";
            break;
        default:
            break;
Don Gagne's avatar
Don Gagne committed
91 92 93
    }
    
    return triggers;
94 95
}

96
QUrl SensorsComponent::setupSource(void) const
97
{
98
    return QUrl::fromUserInput("qrc:/qml/SensorsComponent.qml");
99 100
}

101
QUrl SensorsComponent::summaryQmlSource(void) const
102
{
103 104
    QString summaryQml;
    
105 106 107 108 109 110 111 112 113 114
    switch (_vehicle->vehicleType()) {
        case MAV_TYPE_FIXED_WING:
        case MAV_TYPE_VTOL_DUOROTOR:
        case MAV_TYPE_VTOL_QUADROTOR:
        case MAV_TYPE_VTOL_TILTROTOR:
            summaryQml = "qrc:/qml/SensorsComponentSummaryFixedWing.qml";
            break;
        default:
            summaryQml = "qrc:/qml/SensorsComponentSummary.qml";
            break;
115 116 117
    }
    
    return QUrl::fromUserInput(summaryQml);
118
}
Don Gagne's avatar
Don Gagne committed
119 120 121 122 123 124 125 126 127 128 129 130

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