APMAutoPilotPlugin.cc 5.35 KB
Newer Older
1
/*=====================================================================
Don Gagne's avatar
Don Gagne committed
2

3
 QGroundControl Open Source Ground Control Station
4

5
 (c) 2009 - 2015 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
6

7
 This file is part of the QGROUNDCONTROL project
8

9 10 11 12
 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.
13

14 15 16 17
 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.
18

19 20
 You should have received a copy of the GNU General Public License
 along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.
21

22 23 24 25 26
 ======================================================================*/

#include "APMAutoPilotPlugin.h"
#include "AutoPilotPluginManager.h"
#include "UAS.h"
27
#include "FirmwarePlugin/APM/APMParameterMetaData.h"  // FIXME: Hack
28
#include "FirmwarePlugin/APM/APMFirmwarePlugin.h"  // FIXME: Hack
29 30 31 32 33 34 35 36 37 38 39 40
#include "FirmwarePlugin/APM/ArduCopterFirmwarePlugin.h"
#include "APMComponent.h"
#include "APMAirframeComponent.h"
#include "APMAirframeComponentAirframes.h"
#include "APMAirframeComponentController.h"
#include "APMAirframeLoader.h"
#include "APMRemoteParamsDownloader.h"
#include "APMFlightModesComponent.h"
#include "APMRadioComponent.h"
#include "APMSafetyComponent.h"
#include "APMTuningComponent.h"
#include "APMSensorsComponent.h"
Don Gagne's avatar
Don Gagne committed
41
#include "APMPowerComponent.h"
Don Gagne's avatar
Don Gagne committed
42
#include "APMCameraComponent.h"
43 44

/// This is the AutoPilotPlugin implementatin for the MAV_AUTOPILOT_ARDUPILOT type.
45 46 47 48
APMAutoPilotPlugin::APMAutoPilotPlugin(Vehicle* vehicle, QObject* parent)
    : AutoPilotPlugin(vehicle, parent)
    , _incorrectParameterVersion(false)
    , _airframeComponent(NULL)
Don Gagne's avatar
Don Gagne committed
49
    , _cameraComponent(NULL)
Don Gagne's avatar
Don Gagne committed
50
    , _flightModesComponent(NULL)
Don Gagne's avatar
Don Gagne committed
51
    , _powerComponent(NULL)
Don Gagne's avatar
Don Gagne committed
52
    , _radioComponent(NULL)
Don Gagne's avatar
Don Gagne committed
53 54
    , _safetyComponent(NULL)
    , _sensorsComponent(NULL)
Don Gagne's avatar
Don Gagne committed
55
    , _tuningComponent(NULL)
56
    , _airframeFacts(new APMAirframeLoader(this, vehicle->uas(), this))
57
{
58
    APMAirframeLoader::loadAirframeFactMetaData();
59 60 61 62 63 64 65 66 67
}

APMAutoPilotPlugin::~APMAutoPilotPlugin()
{

}

const QVariantList& APMAutoPilotPlugin::vehicleComponents(void)
{
68 69
    if (_components.count() == 0 && !_incorrectParameterVersion) {
        Q_ASSERT(_vehicle);
70

71
        if (parametersReady()) {
72
            _airframeComponent = new APMAirframeComponent(_vehicle, this);
73 74
            _airframeComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_airframeComponent));
Don Gagne's avatar
Don Gagne committed
75

Don Gagne's avatar
Don Gagne committed
76 77 78 79
            _cameraComponent = new APMCameraComponent(_vehicle, this);
            _cameraComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_cameraComponent));

Don Gagne's avatar
Don Gagne committed
80
            _flightModesComponent = new APMFlightModesComponent(_vehicle, this);
81 82
            _flightModesComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_flightModesComponent));
Don Gagne's avatar
Don Gagne committed
83

Don Gagne's avatar
Don Gagne committed
84
            _powerComponent = new APMPowerComponent(_vehicle, this);
85 86
            _powerComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_powerComponent));
Don Gagne's avatar
Don Gagne committed
87

Don Gagne's avatar
Don Gagne committed
88
            _radioComponent = new APMRadioComponent(_vehicle, this);
89 90
            _radioComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_radioComponent));
Don Gagne's avatar
Don Gagne committed
91 92

            _sensorsComponent = new APMSensorsComponent(_vehicle, this);
93 94
            _sensorsComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_sensorsComponent));
Don Gagne's avatar
Don Gagne committed
95 96

            _safetyComponent = new APMSafetyComponent(_vehicle, this);
97 98
            _safetyComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_safetyComponent));
Don Gagne's avatar
Don Gagne committed
99 100

            _tuningComponent = new APMTuningComponent(_vehicle, this);
101 102
            _tuningComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_tuningComponent));
103 104 105 106 107 108
        } else {
            qWarning() << "Call to vehicleCompenents prior to parametersReady";
        }
    }

    return _components;
109 110 111 112 113 114 115
}

/// This will perform various checks prior to signalling that the plug in ready
void APMAutoPilotPlugin::_parametersReadyPreChecks(bool missingParameters)
{
#if 0
    I believe APM has parameter version stamp, we should check that
Don Gagne's avatar
Don Gagne committed
116 117 118 119 120

            // Check for older parameter version set
            // FIXME: Firmware is moving to version stamp parameter set. Once that is complete the version stamp
            // should be used instead.
            if (parameterExists(FactSystem::defaultComponentId, "SENS_GYRO_XOFF")) {
121
        _incorrectParameterVersion = true;
122 123
        qgcApp()->showMessage("This version of GroundControl can only perform vehicle setup on a newer version of firmware. "
                              "Please perform a Firmware Upgrade if you wish to use Vehicle Setup.");
Don Gagne's avatar
Don Gagne committed
124
    }
125
#endif
126
    Q_UNUSED(missingParameters);
127
    _parametersReady = true;
128
    _missingParameters = false; // we apply only the parameters that do exists on the FactSystem.
129 130 131
    emit missingParametersChanged(_missingParameters);
    emit parametersReadyChanged(_parametersReady);
}