PositionManager.cpp 2.82 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 33 34 35 36 37 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 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88
/*=====================================================================

 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();

    // if the default source is not availble for whatever reason
    // fall back to a simulated source

    if(_defaultSource == nullptr) {
        _defaultSource = _simulatedSource;
    }

    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)
{
    if(_currentSource != nullptr) {
        _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;
    }

    _updateInterval = _currentSource->minimumUpdateInterval();
    _currentSource->setPreferredPositioningMethods(QGeoPositionInfoSource::SatellitePositioningMethods);
    _currentSource->setUpdateInterval(_updateInterval);
    _currentSource->startUpdates();

    connect(_currentSource, SIGNAL(positionUpdated(QGeoPositionInfo)), this, SLOT(positionUpdated(QGeoPositionInfo)));
}