PositionManager.cpp 2.85 KB
Newer Older
Jimmy Johnson's avatar
Jimmy Johnson 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 28 29 30 31 32
/*=====================================================================

 QGroundControl Open Source Ground Control Station

 (c) 2009 - 2016 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/>.

 ======================================================================*/
#include "PositionManager.h"

QGCPositionManager::QGCPositionManager(QGCApplication* app) :
    QGCTool(app),
    _updateInterval(0),
    _currentSource(nullptr)
{
    _defaultSource = QGeoPositionInfoSource::createDefaultSource(this);
    _simulatedSource = new SimulatedPosition();

33
    // Enable this to get a simulated target on desktop
Jimmy Johnson's avatar
Jimmy Johnson committed
34

35 36 37
    // if (_defaultSource == nullptr) {
    //     _defaultSource = _simulatedSource;
    // }
Jimmy Johnson's avatar
Jimmy Johnson committed
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

    setPositionSource(QGCPositionSource::GPS);
}

QGCPositionManager::~QGCPositionManager()
{
    delete(_simulatedSource);
}

void QGCPositionManager::positionUpdated(const QGeoPositionInfo &update)
{

    QGeoCoordinate position(update.coordinate().latitude(), update.coordinate().longitude());

    emit lastPositionUpdated(update.isValid(), QVariant::fromValue(position));
    emit positionInfoUpdated(update);
}

int QGCPositionManager::updateInterval() const
{
    return _updateInterval;
}

void QGCPositionManager::setPositionSource(QGCPositionManager::QGCPositionSource source)
{
63
    if (_currentSource != nullptr) {
Jimmy Johnson's avatar
Jimmy Johnson committed
64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79
        _currentSource->stopUpdates();
        disconnect(_currentSource, SIGNAL(positionUpdated(QGeoPositionInfo)), this, SLOT(positionUpdated(QGeoPositionInfo)));
    }

    switch(source) {
    case QGCPositionManager::Log:
        break;
    case QGCPositionManager::Simulated:
        _currentSource = _simulatedSource;
        break;
    case QGCPositionManager::GPS:
    default:        
        _currentSource = _defaultSource;
        break;
    }

80 81 82 83 84
    if (_currentSource != nullptr) {
        _updateInterval = _currentSource->minimumUpdateInterval();
        _currentSource->setPreferredPositioningMethods(QGeoPositionInfoSource::SatellitePositioningMethods);
        _currentSource->setUpdateInterval(_updateInterval);
        _currentSource->startUpdates();
Jimmy Johnson's avatar
Jimmy Johnson committed
85

86 87
        connect(_currentSource, SIGNAL(positionUpdated(QGeoPositionInfo)), this, SLOT(positionUpdated(QGeoPositionInfo)));
    }
Jimmy Johnson's avatar
Jimmy Johnson committed
88 89
}