RadioComponent.cc 4.87 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 28
/*=====================================================================
 
 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 "RadioComponent.h"
#include "PX4RCCalibration.h"
Don Gagne's avatar
Don Gagne committed
29
#include "PX4AutoPilotPlugin.h"
30

Don Gagne's avatar
Don Gagne committed
31 32
RadioComponent::RadioComponent(UASInterface* uas, AutoPilotPlugin* autopilot, QObject* parent) :
    PX4Component(uas, autopilot, parent),
33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48
    _name(tr("Radio"))
{
}

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

QString RadioComponent::description(void) const
{
    return tr("The Radio Component is used to setup which channels on your RC Transmitter you will use for each vehicle control such as Roll, Pitch, Yaw and Throttle. "
              "It also allows you to assign switches and dials to the various flight modes. "
              "Prior to flight you must also calibrate the extents for all of your channels.");
}

49
QString RadioComponent::iconResource(void) const
50
{
51
    return "RadioComponentIcon.png";
52 53 54 55 56 57 58 59 60
}

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

bool RadioComponent::setupComplete(void) const
{
Don Gagne's avatar
Don Gagne committed
61 62 63 64
    // Check for mapped attitude controls
    QStringList attitudeMappings;
    attitudeMappings << "RC_MAP_ROLL" << "RC_MAP_PITCH" << "RC_MAP_YAW" << "RC_MAP_THROTTLE";
    foreach(QString mapParam, attitudeMappings) {
65
        if (_autopilot->getParameterFact(mapParam)->value().toInt() == 0) {
66 67
            return false;
        }
68
    }
69
    
Don Gagne's avatar
Don Gagne committed
70 71 72 73 74 75 76 77 78 79 80 81 82
    // Check for min/max/trim defaults for channel 1-4
    
    static const int rcMinDefault = 1000;
    static const int rcMaxDefault = 2000;
    static const int rcTrimDefault = 1500;

    for (int i=1; i<5; i++) {
        QVariant value;
        int rcMin, rcMax, rcTrim;

        QString param;
        
        param = QString("RC%1_MIN").arg(i);
83
        rcMin = _autopilot->getParameterFact(param)->value().toInt();
Don Gagne's avatar
Don Gagne committed
84 85
        
        param = QString("RC%1_MAX").arg(i);
86
        rcMax = _autopilot->getParameterFact(param)->value().toInt();
Don Gagne's avatar
Don Gagne committed
87 88
        
        param = QString("RC%1_TRIM").arg(i);
89
        rcTrim = _autopilot->getParameterFact(param)->value().toInt();
Don Gagne's avatar
Don Gagne committed
90 91 92 93 94 95
        
        if (rcMin == rcMinDefault && rcMax == rcMaxDefault && rcTrim == rcTrimDefault) {
            return false;
        }
    }
    
96
    return true;
97 98 99 100 101 102 103 104 105 106 107 108 109 110
}

QString RadioComponent::setupStateDescription(void) const
{
    const char* stateDescription;
    
    if (requiresSetup()) {
        stateDescription = "Requires calibration";
    } else {
        stateDescription = "Calibrated";
    }
    return QString(stateDescription);
}

Don Gagne's avatar
Don Gagne committed
111
QStringList RadioComponent::setupCompleteChangedTriggerList(void) const
112
{
Don Gagne's avatar
Don Gagne committed
113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129
    QStringList triggers;
    
    // The best we can do to detect the need for a radio calibration is look for trim/min/max still being
    // at defaults. We also look for attitude controls to be mapped. But since they default to channels
    // they are not a very reliable source.
    
    // Attitude control mapping is always a trigger
    triggers << "RC_MAP_ROLL" << "RC_MAP_PITCH" << "RC_MAP_YAW" << "RC_MAP_THROTTLE";
    
    // We also trigger on min/max/trim for channels 1-4 which would normally be the attitude
    // control channels. This may not always be the case, but it's the best we can
    triggers << "RC1_MIN" << "RC1_MAX" << "RC1_TRIM";
    triggers << "RC2_MIN" << "RC2_MAX" << "RC2_TRIM";
    triggers << "RC3_MIN" << "RC3_MAX" << "RC3_TRIM";
    triggers << "RC4_MIN" << "RC4_MAX" << "RC4_TRIM";
    
    return triggers;
130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145
}

QStringList RadioComponent::paramFilterList(void) const
{
    QStringList list;
    
    list << "RC*";
    
    return list;
}

QWidget* RadioComponent::setupWidget(void) const
{
    return new PX4RCCalibration;
}

146
QUrl RadioComponent::summaryQmlSource(void) const
147
{
148
    return QUrl::fromUserInput("qrc:/qml/RadioComponentSummary.qml");
149
}
Don Gagne's avatar
Don Gagne committed
150 151 152 153 154 155 156 157 158 159 160 161

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