AutoPilotPlugin.cc 5.2 KB
Newer Older
Don Gagne's avatar
Don Gagne committed
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 - 2015 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 "AutoPilotPlugin.h"
28
#include "QGCApplication.h"
29
#include "ParameterLoader.h"
30
#include "UAS.h"
31
#include "FirmwarePlugin.h"
Don Gagne's avatar
Don Gagne committed
32

33 34 35
AutoPilotPlugin::AutoPilotPlugin(Vehicle* vehicle, QObject* parent)
    : QObject(parent)
    , _vehicle(vehicle)
36
    , _firmwarePlugin(vehicle->firmwarePlugin())
37 38 39
    , _parametersReady(false)
    , _missingParameters(false)
	, _setupComplete(false)
Don Gagne's avatar
Don Gagne committed
40
{
41
    Q_ASSERT(vehicle);
42
	
43
	connect(_vehicle->uas(), &UASInterface::disconnected, this, &AutoPilotPlugin::_uasDisconnected);
44

45
	connect(this, &AutoPilotPlugin::parametersReadyChanged, this, &AutoPilotPlugin::_parametersReadyChanged);
46 47
}

48 49 50 51 52
AutoPilotPlugin::~AutoPilotPlugin()
{
    
}

53 54
void AutoPilotPlugin::_uasDisconnected(void)
{
55 56
	_parametersReady = false;
	emit parametersReadyChanged(_parametersReady);
Don Gagne's avatar
Don Gagne committed
57 58
}

59
void AutoPilotPlugin::_parametersReadyChanged(bool parametersReady)
60
{
61
	if (parametersReady) {
62 63
		_recalcSetupComplete();
		if (!_setupComplete) {
64
            qgcApp()->showMessage("One or more vehicle components require setup prior to flight.");
65 66
			
			// Take the user to Vehicle Summary
Don Gagne's avatar
Don Gagne committed
67
            qgcApp()->showSetupView();
68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94
			qgcApp()->processEvents(QEventLoop::ExcludeUserInputEvents);
		}
	}
}

void AutoPilotPlugin::_recalcSetupComplete(void)
{
	bool newSetupComplete = true;
	
	foreach(const QVariant componentVariant, vehicleComponents()) {
		VehicleComponent* component = qobject_cast<VehicleComponent*>(qvariant_cast<QObject *>(componentVariant));
		Q_ASSERT(component);
		
		if (!component->setupComplete()) {
			newSetupComplete = false;
			break;
		}
	}
	
	if (_setupComplete != newSetupComplete) {
		_setupComplete = newSetupComplete;
		emit setupCompleteChanged(_setupComplete);
	}
}

bool AutoPilotPlugin::setupComplete(void)
{
95
	Q_ASSERT(_parametersReady);
96 97 98
	return _setupComplete;
}

99 100 101
void AutoPilotPlugin::resetAllParametersToDefaults(void)
{
    mavlink_message_t msg;
102
    MAVLinkProtocol* mavlink = qgcApp()->toolbox()->mavlinkProtocol();
103

104 105
    mavlink_msg_command_long_pack(mavlink->getSystemId(), mavlink->getComponentId(), &msg, _vehicle->uas()->getUASID(), 0, MAV_CMD_PREFLIGHT_STORAGE, 0, 2, -1, 0, 0, 0, 0, 0);
    _vehicle->sendMessage(msg);
106 107
}

dogmaphobic's avatar
dogmaphobic committed
108
void AutoPilotPlugin::refreshAllParameters(unsigned char componentID)
109
{
dogmaphobic's avatar
dogmaphobic committed
110
    _vehicle->getParameterLoader()->refreshAllParameters((uint8_t)componentID);
111 112 113 114
}

void AutoPilotPlugin::refreshParameter(int componentId, const QString& name)
{
115
    _vehicle->getParameterLoader()->refreshParameter(componentId, name);
116 117 118 119
}

void AutoPilotPlugin::refreshParametersPrefix(int componentId, const QString& namePrefix)
{
120
    _vehicle->getParameterLoader()->refreshParametersPrefix(componentId, namePrefix);
121 122
}

Don Gagne's avatar
Don Gagne committed
123
bool AutoPilotPlugin::parameterExists(int componentId, const QString& name)
124
{
125
    return _vehicle->getParameterLoader()->parameterExists(componentId, name);
126 127
}

Don Gagne's avatar
Don Gagne committed
128
Fact* AutoPilotPlugin::getParameterFact(int componentId, const QString& name)
129
{
130
    return _vehicle->getParameterLoader()->getFact(componentId, name);
131 132
}

133
bool AutoPilotPlugin::factExists(FactSystem::Provider_t provider, int componentId, const QString& name)
Don Gagne's avatar
Don Gagne committed
134
{
135 136
    switch (provider) {
        case FactSystem::ParameterProvider:
137
            return _vehicle->getParameterLoader()->parameterExists(componentId, name);
138 139
            
        // Other providers will go here once they come online
Don Gagne's avatar
Don Gagne committed
140
    }
Don Gagne's avatar
Don Gagne committed
141 142 143
    
    Q_ASSERT(false);
    return false;
Don Gagne's avatar
Don Gagne committed
144
}
145

146
Fact* AutoPilotPlugin::getFact(FactSystem::Provider_t provider, int componentId, const QString& name)
147
{
148 149
    switch (provider) {
        case FactSystem::ParameterProvider:
150
            return _vehicle->getParameterLoader()->getFact(componentId, name);
151 152 153
            
        // Other providers will go here once they come online
    }
Don Gagne's avatar
Don Gagne committed
154 155
    
    Q_ASSERT(false);
Don Gagne's avatar
Don Gagne committed
156
    return NULL;
157
}
158

Don Gagne's avatar
Don Gagne committed
159
QStringList AutoPilotPlugin::parameterNames(int componentId)
160
{
161
    return _vehicle->getParameterLoader()->parameterNames(componentId);
162 163 164 165
}

const QMap<int, QMap<QString, QStringList> >& AutoPilotPlugin::getGroupMap(void)
{
166
    return _vehicle->getParameterLoader()->getGroupMap();
167 168 169 170
}

void AutoPilotPlugin::writeParametersToStream(QTextStream &stream)
{
171
    _vehicle->getParameterLoader()->writeParametersToStream(stream);
172 173
}

174
QString AutoPilotPlugin::readParametersFromStream(QTextStream &stream)
175
{
176
    return _vehicle->getParameterLoader()->readParametersFromStream(stream);
177
}