HomePositionManager.cc 5.62 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
/*=====================================================================
 
 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/>.
 
 ======================================================================*/
pixhawk's avatar
pixhawk committed
23 24 25 26

#include <QList>
#include <QApplication>
#include <QTimer>
27
#include <QSettings>
28
#include <QtQml>
Don Gagne's avatar
Don Gagne committed
29

pixhawk's avatar
pixhawk committed
30
#include "UAS.h"
31
#include "UASInterface.h"
32
#include "HomePositionManager.h"
33
#include "QGC.h"
34
#include "QGCApplication.h"
35
#include "MultiVehicleManager.h"
pixhawk's avatar
pixhawk committed
36

LM's avatar
LM committed
37 38 39 40
#define PI 3.1415926535897932384626433832795
#define MEAN_EARTH_DIAMETER	12756274.0
#define UMR	0.017453292519943295769236907684886

41 42 43 44 45
const char* HomePositionManager::_settingsGroup =   "HomePositionManager";
const char* HomePositionManager::_latitudeKey =     "Latitude";
const char* HomePositionManager::_longitudeKey =    "Longitude";
const char* HomePositionManager::_altitudeKey =     "Altitude";

46 47
HomePositionManager::HomePositionManager(QGCApplication* app)
    : QGCTool(app)
48 49 50
    , homeLat(47.3769)
    , homeLon(8.549444)
    , homeAlt(470.0)
51
{
Don Gagne's avatar
Don Gagne committed
52
    qmlRegisterUncreatableType<HomePositionManager> ("QGroundControl", 1, 0, "HomePositionManager", "Reference only");
53 54
}

55
void HomePositionManager::setToolbox(QGCToolbox *toolbox)
56
{
57 58
    QGCTool::setToolbox(toolbox);

59

60
    _loadSettings();
61 62
}

63
void HomePositionManager::_storeSettings(void)
64 65
{
    QSettings settings;
66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84
    
    settings.remove(_settingsGroup);
    settings.beginGroup(_settingsGroup);
    
    for (int i=0; i<_homePositions.count(); i++) {
        HomePosition* homePos = qobject_cast<HomePosition*>(_homePositions[i]);
        
        qDebug() << "Saving" << homePos->name();
        
        settings.beginGroup(homePos->name());
        settings.setValue(_latitudeKey, homePos->coordinate().latitude());
        settings.setValue(_longitudeKey, homePos->coordinate().longitude());
        settings.setValue(_altitudeKey, homePos->coordinate().altitude());
        settings.endGroup();
    }
    
    settings.endGroup();
    
    // Deprecated settings for old editor
85 86 87 88 89 90 91
    settings.beginGroup("QGC_UASMANAGER");
    settings.setValue("HOMELAT", homeLat);
    settings.setValue("HOMELON", homeLon);
    settings.setValue("HOMEALT", homeAlt);
    settings.endGroup();
}

92
void HomePositionManager::_loadSettings(void)
93 94
{
    QSettings settings;
95 96 97 98 99
    
    _homePositions.clear();
    
    settings.beginGroup(_settingsGroup);
    
100
    foreach(const QString &name, settings.childGroups()) {
101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116
        QGeoCoordinate coordinate;
        
        qDebug() << "Load setting" << name;
        
        settings.beginGroup(name);
        coordinate.setLatitude(settings.value(_latitudeKey).toDouble());
        coordinate.setLongitude(settings.value(_longitudeKey).toDouble());
        coordinate.setAltitude(settings.value(_altitudeKey).toDouble());
        settings.endGroup();
        
        _homePositions.append(new HomePosition(name, coordinate, this));
    }
    
    settings.endGroup();
    
    if (_homePositions.count() == 0) {
117
        _homePositions.append(new HomePosition("ETH Campus", QGeoCoordinate(47.3769, 8.549444, 470.0), this));
Don Gagne's avatar
Don Gagne committed
118
    }    
119 120
}

121
void HomePositionManager::updateHomePosition(const QString& name, const QGeoCoordinate& coordinate)
122
{
123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141
    HomePosition * homePos = NULL;
    
    for (int i=0; i<_homePositions.count(); i++) {
        homePos = qobject_cast<HomePosition*>(_homePositions[i]);
        if (homePos->name() == name) {
            break;
        }
        homePos = NULL;
    }
    
    if (homePos == NULL) {
        HomePosition* homePos = new HomePosition(name, coordinate, this);
        _homePositions.append(homePos);
    } else {
        homePos->setName(name);
        homePos->setCoordinate(coordinate);
    }
    
    _storeSettings();
142
}
LM's avatar
LM committed
143

144
void HomePositionManager::deleteHomePosition(const QString& name)
145
{
146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162
    // Don't allow delete of last position
    if (_homePositions.count() == 1) {
        return;
    }
    
    qDebug() << "Attempting delete" << name;
    
    for (int i=0; i<_homePositions.count(); i++) {
        if (qobject_cast<HomePosition*>(_homePositions[i])->name() == name) {
            qDebug() << "Deleting" << name;
            _homePositions.removeAt(i);
            break;
        }
    }
    
    _storeSettings();
}
LM's avatar
LM committed
163

164
HomePosition::HomePosition(const QString& name, const QGeoCoordinate& coordinate, HomePositionManager* homePositionManager, QObject* parent)
165 166
    : QObject(parent)
    , _coordinate(coordinate)
167
    , _homePositionManager(homePositionManager)
168 169
{
    setObjectName(name);
170 171
}

172
HomePosition::~HomePosition()
173
{
174
    
175 176
}

177
QString HomePosition::name(void)
178
{
179
    return objectName();
180
}
LM's avatar
LM committed
181

182
void HomePosition::setName(const QString& name)
LM's avatar
LM committed
183
{
184
    setObjectName(name);
185
    _homePositionManager->_storeSettings();
186
    emit nameChanged(name);
LM's avatar
LM committed
187 188
}

189
QGeoCoordinate HomePosition::coordinate(void)
LM's avatar
LM committed
190
{
191
    return _coordinate;
LM's avatar
LM committed
192 193
}

194 195 196
void HomePosition::setCoordinate(const QGeoCoordinate& coordinate)
{
    _coordinate = coordinate;
197
    _homePositionManager->_storeSettings();
198 199
    emit coordinateChanged(coordinate);
}