APMAutoPilotPlugin.cc 5.17 KB
Newer Older
1 2 3 4 5 6 7 8
/****************************************************************************
 *
 *   (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.
 *
 ****************************************************************************/
Don Gagne's avatar
Don Gagne committed
9

10 11 12 13

#include "APMAutoPilotPlugin.h"
#include "AutoPilotPluginManager.h"
#include "UAS.h"
14
#include "FirmwarePlugin/APM/APMParameterMetaData.h"  // FIXME: Hack
15
#include "FirmwarePlugin/APM/APMFirmwarePlugin.h"  // FIXME: Hack
16
#include "FirmwarePlugin/APM/ArduCopterFirmwarePlugin.h"
17
#include "VehicleComponent.h"
18 19 20 21 22 23 24 25 26
#include "APMAirframeComponent.h"
#include "APMAirframeComponentAirframes.h"
#include "APMAirframeComponentController.h"
#include "APMAirframeLoader.h"
#include "APMFlightModesComponent.h"
#include "APMRadioComponent.h"
#include "APMSafetyComponent.h"
#include "APMTuningComponent.h"
#include "APMSensorsComponent.h"
Don Gagne's avatar
Don Gagne committed
27
#include "APMPowerComponent.h"
Don Gagne's avatar
Don Gagne committed
28
#include "APMCameraComponent.h"
29
#include "ESP8266Component.h"
30 31

/// This is the AutoPilotPlugin implementatin for the MAV_AUTOPILOT_ARDUPILOT type.
32 33 34 35
APMAutoPilotPlugin::APMAutoPilotPlugin(Vehicle* vehicle, QObject* parent)
    : AutoPilotPlugin(vehicle, parent)
    , _incorrectParameterVersion(false)
    , _airframeComponent(NULL)
Don Gagne's avatar
Don Gagne committed
36
    , _cameraComponent(NULL)
Don Gagne's avatar
Don Gagne committed
37
    , _flightModesComponent(NULL)
Don Gagne's avatar
Don Gagne committed
38
    , _powerComponent(NULL)
Don Gagne's avatar
Don Gagne committed
39
    , _radioComponent(NULL)
Don Gagne's avatar
Don Gagne committed
40 41
    , _safetyComponent(NULL)
    , _sensorsComponent(NULL)
Don Gagne's avatar
Don Gagne committed
42
    , _tuningComponent(NULL)
43
    , _airframeFacts(new APMAirframeLoader(this, vehicle->uas(), this))
44
    , _esp8266Component(NULL)
45
{
46
    APMAirframeLoader::loadAirframeFactMetaData();
47 48 49 50 51 52 53 54 55
}

APMAutoPilotPlugin::~APMAutoPilotPlugin()
{

}

const QVariantList& APMAutoPilotPlugin::vehicleComponents(void)
{
56 57
    if (_components.count() == 0 && !_incorrectParameterVersion) {
        Q_ASSERT(_vehicle);
58

59
        if (parametersReady()) {
60
            _airframeComponent = new APMAirframeComponent(_vehicle, this);
61 62
            _airframeComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_airframeComponent));
Don Gagne's avatar
Don Gagne committed
63 64

            _radioComponent = new APMRadioComponent(_vehicle, this);
65 66
            _radioComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_radioComponent));
Don Gagne's avatar
Don Gagne committed
67

Don Gagne's avatar
Don Gagne committed
68 69 70
            _flightModesComponent = new APMFlightModesComponent(_vehicle, this);
            _flightModesComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_flightModesComponent));
71

Don Gagne's avatar
Don Gagne committed
72
            _sensorsComponent = new APMSensorsComponent(_vehicle, this);
73 74
            _sensorsComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_sensorsComponent));
Don Gagne's avatar
Don Gagne committed
75

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

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

            _tuningComponent = new APMTuningComponent(_vehicle, this);
85 86
            _tuningComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_tuningComponent));
87

Don Gagne's avatar
Don Gagne committed
88 89 90 91 92 93 94 95 96 97
            _cameraComponent = new APMCameraComponent(_vehicle, this);
            _cameraComponent->setupTriggerSignals();
            _components.append(QVariant::fromValue((VehicleComponent*)_cameraComponent));

            //-- Is there an ESP8266 Connected?
            if(factExists(FactSystem::ParameterProvider, MAV_COMP_ID_UDP_BRIDGE, "SW_VER")) {
                _esp8266Component = new ESP8266Component(_vehicle, this);
                _esp8266Component->setupTriggerSignals();
                _components.append(QVariant::fromValue((VehicleComponent*)_esp8266Component));
            }
98 99 100 101 102 103
        } else {
            qWarning() << "Call to vehicleCompenents prior to parametersReady";
        }
    }

    return _components;
104 105 106 107 108 109 110
}

/// 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
111 112 113 114 115

            // 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")) {
116
        _incorrectParameterVersion = true;
117 118
        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
119
    }
120
#endif
121
    Q_UNUSED(missingParameters);
122
    _parametersReady = true;
123
    _missingParameters = false; // we apply only the parameters that do exists on the FactSystem.
124 125 126
    emit missingParametersChanged(_missingParameters);
    emit parametersReadyChanged(_parametersReady);
}