AutoPilotPlugin.cc 3.49 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 "QGCUASParamManagerInterface.h"
Don Gagne's avatar
Don Gagne committed
29 30 31

AutoPilotPlugin::AutoPilotPlugin(UASInterface* uas, QObject* parent) :
    QObject(parent),
32 33
    _uas(uas),
    _pluginReady(false)
Don Gagne's avatar
Don Gagne committed
34 35 36 37
{
    Q_ASSERT(_uas);
}

38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62
void AutoPilotPlugin::refreshAllParameters(void)
{
	_getParameterLoader()->refreshAllParameters();
}

void AutoPilotPlugin::refreshParameter(int componentId, const QString& name)
{
	_getParameterLoader()->refreshParameter(componentId, name);
}

void AutoPilotPlugin::refreshParametersPrefix(int componentId, const QString& namePrefix)
{
	_getParameterLoader()->refreshParametersPrefix(componentId, namePrefix);
}

bool AutoPilotPlugin::parameterExists(const QString& name)
{
	return _getParameterLoader()->parameterExists(FactSystem::defaultComponentId, name);
}

Fact* AutoPilotPlugin::getParameterFact(const QString& name)
{
	return _getParameterLoader()->getFact(FactSystem::defaultComponentId, name);
}

63
bool AutoPilotPlugin::factExists(FactSystem::Provider_t provider, int componentId, const QString& name)
Don Gagne's avatar
Don Gagne committed
64
{
65 66
    switch (provider) {
        case FactSystem::ParameterProvider:
67
            return _getParameterLoader()->parameterExists(componentId, name);
68 69
            
        // Other providers will go here once they come online
Don Gagne's avatar
Don Gagne committed
70
    }
Don Gagne's avatar
Don Gagne committed
71 72 73
    
    Q_ASSERT(false);
    return false;
Don Gagne's avatar
Don Gagne committed
74
}
75

76
Fact* AutoPilotPlugin::getFact(FactSystem::Provider_t provider, int componentId, const QString& name)
77
{
78 79
    switch (provider) {
        case FactSystem::ParameterProvider:
80
            return _getParameterLoader()->getFact(componentId, name);
81 82 83
            
        // Other providers will go here once they come online
    }
Don Gagne's avatar
Don Gagne committed
84 85
    
    Q_ASSERT(false);
Don Gagne's avatar
Don Gagne committed
86
    return NULL;
87
}
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124

QStringList AutoPilotPlugin::parameterNames(void)
{
	return _getParameterLoader()->parameterNames();
}

const QMap<int, QMap<QString, QStringList> >& AutoPilotPlugin::getGroupMap(void)
{
    return _getParameterLoader()->getGroupMap();
}

void AutoPilotPlugin::writeParametersToStream(QTextStream &stream)
{
	Q_ASSERT(_uas);
	
	_uas->getParamManager()->writeOnboardParamsToStream(stream, _uas->getUASName());
}

void AutoPilotPlugin::readParametersFromStream(QTextStream &stream)
{
	Q_ASSERT(_uas);
	
	Fact* autoSaveFact = NULL;
	int previousAutoSave = 0;
	
	if (parameterExists("COM_AUTOS_PAR")) {
		autoSaveFact = getParameterFact("COM_AUTOS_PAR");
		previousAutoSave = autoSaveFact->value().toInt();
		autoSaveFact->setValue(1);
	}
	
	_uas->getParamManager()->readPendingParamsFromStream(stream);
	
	if (autoSaveFact) {
		autoSaveFact->setValue(previousAutoSave);
	}
}