LinkManager.cc 30.6 KB
Newer Older
pixhawk's avatar
pixhawk committed
1
/*=====================================================================
lm's avatar
lm committed
2 3 4

QGroundControl Open Source Ground Control Station

5
(c) 2009, 2015 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
lm's avatar
lm committed
6 7 8 9

This file is part of the QGROUNDCONTROL project

    QGROUNDCONTROL is free software: you can redistribute it and/or modify
pixhawk's avatar
pixhawk committed
10 11 12
    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.
lm's avatar
lm committed
13 14

    QGROUNDCONTROL is distributed in the hope that it will be useful,
pixhawk's avatar
pixhawk committed
15 16 17
    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.
lm's avatar
lm committed
18

pixhawk's avatar
pixhawk committed
19
    You should have received a copy of the GNU General Public License
lm's avatar
lm committed
20 21
    along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.

pixhawk's avatar
pixhawk committed
22
======================================================================*/
23

pixhawk's avatar
pixhawk committed
24 25 26 27 28 29 30 31 32 33
/**
 * @file
 *   @brief Brief Description
 *
 *   @author Lorenz Meier <mavteam@student.ethz.ch>
 *
 */

#include <QList>
#include <QApplication>
34
#include <QDebug>
dogmaphobic's avatar
dogmaphobic committed
35 36

#ifndef __ios__
Don Gagne's avatar
Don Gagne committed
37
#include "QGCSerialPortInfo.h"
dogmaphobic's avatar
dogmaphobic committed
38
#endif
39

40
#include "LinkManager.h"
41
#include "QGCApplication.h"
Don Gagne's avatar
Don Gagne committed
42 43
#include "UDPLink.h"
#include "TCPLink.h"
dogmaphobic's avatar
dogmaphobic committed
44
#ifdef QGC_ENABLE_BLUETOOTH
dogmaphobic's avatar
dogmaphobic committed
45 46
#include "BluetoothLink.h"
#endif
47

Don Gagne's avatar
Don Gagne committed
48
QGC_LOGGING_CATEGORY(LinkManagerLog, "LinkManagerLog")
Don Gagne's avatar
Don Gagne committed
49 50 51 52 53 54 55
QGC_LOGGING_CATEGORY(LinkManagerVerboseLog, "LinkManagerVerboseLog")

const char* LinkManager::_settingsGroup =           "LinkManager";
const char* LinkManager::_autoconnectUDPKey =       "AutoconnectUDP";
const char* LinkManager::_autoconnectPixhawkKey =   "AutoconnectPixhawk";
const char* LinkManager::_autoconnect3DRRadioKey =  "Autoconnect3DRRadio";
const char* LinkManager::_autoconnectPX4FlowKey =   "AutoconnectPX4Flow";
Don Gagne's avatar
Don Gagne committed
56
const char* LinkManager::_defaultUPDLinkName =      "Default UDP Link";
57

58 59 60 61 62 63 64 65
const int LinkManager::_autoconnectUpdateTimerMSecs =   1000;
#ifdef Q_OS_WIN
// Have to manually let the bootloader go by on Windows to get a working connect
const int LinkManager::_autoconnectConnectDelayMSecs =  6000;
#else
const int LinkManager::_autoconnectConnectDelayMSecs =  1000;
#endif

66 67
LinkManager::LinkManager(QGCApplication* app)
    : QGCTool(app)
68 69 70
    , _configUpdateSuspended(false)
    , _configurationsLoaded(false)
    , _connectionsSuspended(false)
71
    , _mavlinkChannelsUsedBitMask(0)
72
    , _mavlinkProtocol(NULL)
Don Gagne's avatar
Don Gagne committed
73 74 75 76 77
    , _autoconnectUDP(true)
    , _autoconnectPixhawk(true)
    , _autoconnect3DRRadio(true)
    , _autoconnectPX4Flow(true)

pixhawk's avatar
pixhawk committed
78
{
Don Gagne's avatar
Don Gagne committed
79 80 81 82 83
    qmlRegisterUncreatableType<LinkManager>         ("QGroundControl", 1, 0, "LinkManager",         "Reference only");
    qmlRegisterUncreatableType<LinkConfiguration>   ("QGroundControl", 1, 0, "LinkConfiguration",   "Reference only");
    qmlRegisterUncreatableType<LinkInterface>       ("QGroundControl", 1, 0, "LinkInterface",       "Reference only");

    QSettings settings;
84

Don Gagne's avatar
Don Gagne committed
85 86 87 88 89
    settings.beginGroup(_settingsGroup);
    _autoconnectUDP =       settings.value(_autoconnectUDPKey, true).toBool();
    _autoconnectPixhawk =   settings.value(_autoconnectPixhawkKey, true).toBool();
    _autoconnect3DRRadio =  settings.value(_autoconnect3DRRadioKey, true).toBool();
    _autoconnectPX4Flow =   settings.value(_autoconnectPX4FlowKey, true).toBool();
pixhawk's avatar
pixhawk committed
90 91 92 93
}

LinkManager::~LinkManager()
{
Don Gagne's avatar
Don Gagne committed
94 95
    if (anyActiveLinks()) {
        qWarning() << "Why are there still active links?";
96
    }
pixhawk's avatar
pixhawk committed
97 98
}

99 100 101 102 103
void LinkManager::setToolbox(QGCToolbox *toolbox)
{
   QGCTool::setToolbox(toolbox);

   _mavlinkProtocol = _toolbox->mavlinkProtocol();
Don Gagne's avatar
Don Gagne committed
104
   connect(_mavlinkProtocol, &MAVLinkProtocol::vehicleHeartbeatInfo, this, &LinkManager::_vehicleHeartbeatInfo);
105

Don Gagne's avatar
Don Gagne committed
106
    connect(&_portListTimer, &QTimer::timeout, this, &LinkManager::_updateAutoConnectLinks);
107
    _portListTimer.start(_autoconnectUpdateTimerMSecs); // timeout must be long enough to get past bootloader on second pass
108

109 110
}

Don Gagne's avatar
Don Gagne committed
111
LinkInterface* LinkManager::createConnectedLink(LinkConfiguration* config)
112 113 114 115
{
    Q_ASSERT(config);
    LinkInterface* pLink = NULL;
    switch(config->type()) {
dogmaphobic's avatar
dogmaphobic committed
116
#ifndef __ios__
117 118 119
        case LinkConfiguration::TypeSerial:
            pLink = new SerialLink(dynamic_cast<SerialConfiguration*>(config));
            break;
dogmaphobic's avatar
dogmaphobic committed
120
#endif
121 122 123
        case LinkConfiguration::TypeUdp:
            pLink = new UDPLink(dynamic_cast<UDPConfiguration*>(config));
            break;
124 125 126
        case LinkConfiguration::TypeTcp:
            pLink = new TCPLink(dynamic_cast<TCPConfiguration*>(config));
            break;
dogmaphobic's avatar
dogmaphobic committed
127
#ifdef QGC_ENABLE_BLUETOOTH
dogmaphobic's avatar
dogmaphobic committed
128 129 130 131
        case LinkConfiguration::TypeBluetooth:
            pLink = new BluetoothLink(dynamic_cast<BluetoothConfiguration*>(config));
            break;
#endif
dogmaphobic's avatar
dogmaphobic committed
132
#ifndef __mobile__
Don Gagne's avatar
Don Gagne committed
133 134 135
        case LinkConfiguration::TypeLogReplay:
            pLink = new LogReplayLink(dynamic_cast<LogReplayLinkConfiguration*>(config));
            break;
dogmaphobic's avatar
dogmaphobic committed
136
#endif
137
#ifdef QT_DEBUG
138 139 140
        case LinkConfiguration::TypeMock:
            pLink = new MockLink(dynamic_cast<MockConfiguration*>(config));
            break;
141
#endif
142 143 144
        case LinkConfiguration::TypeLast:
        default:
            break;
145 146
    }
    if(pLink) {
147 148
        _addLink(pLink);
        connectLink(pLink);
149 150 151 152
    }
    return pLink;
}

Don Gagne's avatar
Don Gagne committed
153
LinkInterface* LinkManager::createConnectedLink(const QString& name)
154 155 156
{
    Q_ASSERT(name.isEmpty() == false);
    for(int i = 0; i < _linkConfigurations.count(); i++) {
Don Gagne's avatar
Don Gagne committed
157
        LinkConfiguration* conf = _linkConfigurations.value<LinkConfiguration*>(i);
158
        if(conf && conf->name() == name)
Don Gagne's avatar
Don Gagne committed
159
            return createConnectedLink(conf);
160 161 162 163
    }
    return NULL;
}

164
void LinkManager::_addLink(LinkInterface* link)
pixhawk's avatar
pixhawk committed
165
{
Don Gagne's avatar
Don Gagne committed
166 167 168 169
    if (thread() != QThread::currentThread()) {
        qWarning() << "_deleteLink called from incorrect thread";
        return;
    }
170

Don Gagne's avatar
Don Gagne committed
171 172 173
    if (!link) {
        return;
    }
174

Don Gagne's avatar
Don Gagne committed
175
    if (!_links.contains(link)) {
176 177 178
        // Find a mavlink channel to use for this link
        for (int i=0; i<32; i++) {
            if (!(_mavlinkChannelsUsedBitMask && 1 << i)) {
179
                mavlink_reset_channel_status(i);
180 181 182 183 184
                link->_setMavlinkChannel(i);
                _mavlinkChannelsUsedBitMask |= i << i;
                break;
            }
        }
185

Don Gagne's avatar
Don Gagne committed
186
        _links.append(link);
187 188
        emit newLink(link);
    }
189

Don Gagne's avatar
Don Gagne committed
190 191 192 193
    connect(link, &LinkInterface::communicationError,   _app,               &QGCApplication::criticalMessageBoxOnMainThread);
    connect(link, &LinkInterface::bytesReceived,        _mavlinkProtocol,   &MAVLinkProtocol::receiveBytes);
    connect(link, &LinkInterface::connected,            _mavlinkProtocol,   &MAVLinkProtocol::linkConnected);
    connect(link, &LinkInterface::disconnected,         _mavlinkProtocol,   &MAVLinkProtocol::linkDisconnected);
194

195
    _mavlinkProtocol->resetMetadataForLink(link);
196

197
    connect(link, &LinkInterface::connected,    this, &LinkManager::_linkConnected);
198
    connect(link, &LinkInterface::disconnected, this, &LinkManager::_linkDisconnected);
199
}
pixhawk's avatar
pixhawk committed
200

Don Gagne's avatar
Don Gagne committed
201
void LinkManager::disconnectAll(void)
pixhawk's avatar
pixhawk committed
202
{
Don Gagne's avatar
Don Gagne committed
203 204
    // Walk list in reverse order to preserve indices during delete
    for (int i=_links.count()-1; i>=0; i--) {
Don Gagne's avatar
Don Gagne committed
205
        disconnectLink(_links.value<LinkInterface*>(i));
206
    }
pixhawk's avatar
pixhawk committed
207 208 209 210
}

bool LinkManager::connectLink(LinkInterface* link)
{
211
    Q_ASSERT(link);
212

213 214 215 216
    if (_connectionsSuspendedMsg()) {
        return false;
    }

Don Gagne's avatar
Don Gagne committed
217 218
    bool previousAnyConnectedLinks = anyConnectedLinks();

219
    if (link->_connect()) {
Don Gagne's avatar
Don Gagne committed
220 221 222
        if (!previousAnyConnectedLinks) {
            emit anyConnectedLinksChanged(true);
        }
223 224 225 226
        return true;
    } else {
        return false;
    }
pixhawk's avatar
pixhawk committed
227 228
}

Don Gagne's avatar
Don Gagne committed
229
void LinkManager::disconnectLink(LinkInterface* link)
pixhawk's avatar
pixhawk committed
230
{
231
    Q_ASSERT(link);
Don Gagne's avatar
Don Gagne committed
232

Don Gagne's avatar
Don Gagne committed
233 234
    link->_disconnect();
    LinkConfiguration* config = link->getLinkConfiguration();
235 236 237 238
    if (config) {
        if (_autoconnectConfigurations.contains(config)) {
            config->setLink(NULL);
        }
239
    }
Don Gagne's avatar
Don Gagne committed
240
    _deleteLink(link);
241 242 243 244
    if (_autoconnectConfigurations.contains(config)) {
        _autoconnectConfigurations.removeOne(config);
        delete config;
    }
pixhawk's avatar
pixhawk committed
245 246
}

247
void LinkManager::_deleteLink(LinkInterface* link)
248
{
Don Gagne's avatar
Don Gagne committed
249 250 251 252 253 254 255 256
    if (thread() != QThread::currentThread()) {
        qWarning() << "_deleteLink called from incorrect thread";
        return;
    }

    if (!link) {
        return;
    }
257

258 259
    // Free up the mavlink channel associated with this link
    _mavlinkChannelsUsedBitMask &= ~(1 << link->getMavlinkChannel());
260

Don Gagne's avatar
Don Gagne committed
261 262
    _links.removeOne(link);
    delete link;
263

Don Gagne's avatar
Don Gagne committed
264
    // Emit removal of link
265
    emit linkDeleted(link);
pixhawk's avatar
pixhawk committed
266 267
}

268 269 270 271 272
/// @brief If all new connections should be suspended a message is displayed to the user and true
///         is returned;
bool LinkManager::_connectionsSuspendedMsg(void)
{
    if (_connectionsSuspended) {
273
        qgcApp()->showMessage(QString("Connect not allowed: %1").arg(_connectionsSuspendedReason));
274 275 276 277 278 279 280 281 282 283 284 285
        return true;
    } else {
        return false;
    }
}

void LinkManager::setConnectionsSuspended(QString reason)
{
    _connectionsSuspended = true;
    _connectionsSuspendedReason = reason;
    Q_ASSERT(!reason.isEmpty());
}
286

287 288 289 290 291 292 293 294 295
void LinkManager::_linkConnected(void)
{
    emit linkConnected((LinkInterface*)sender());
}

void LinkManager::_linkDisconnected(void)
{
    emit linkDisconnected((LinkInterface*)sender());
}
296 297 298 299 300 301 302 303 304 305

void LinkManager::suspendConfigurationUpdates(bool suspend)
{
    _configUpdateSuspended = suspend;
}

void LinkManager::saveLinkConfigurationList()
{
    QSettings settings;
    settings.remove(LinkConfiguration::settingsRoot());
306 307
    int trueCount = 0;
    for (int i = 0; i < _linkConfigurations.count(); i++) {
Don Gagne's avatar
Don Gagne committed
308 309 310 311 312
        LinkConfiguration* linkConfig = _linkConfigurations.value<LinkConfiguration*>(i);
        if (linkConfig) {
            if(!linkConfig->isDynamic())
            {
                QString root = LinkConfiguration::settingsRoot();
313
                root += QString("/Link%1").arg(trueCount++);
Don Gagne's avatar
Don Gagne committed
314 315
                settings.setValue(root + "/name", linkConfig->name());
                settings.setValue(root + "/type", linkConfig->type());
316
                settings.setValue(root + "/auto", linkConfig->isAutoConnect());
Don Gagne's avatar
Don Gagne committed
317 318 319 320 321
                // Have the instance save its own values
                linkConfig->saveSettings(settings, root);
            }
        } else {
            qWarning() << "Internal error";
dogmaphobic's avatar
dogmaphobic committed
322
        }
323
    }
dogmaphobic's avatar
dogmaphobic committed
324
    QString root(LinkConfiguration::settingsRoot());
325 326
    settings.setValue(root + "/count", trueCount);
    emit linkConfigurationsChanged();
327 328 329 330
}

void LinkManager::loadLinkConfigurationList()
{
331
    bool linksChanged = false;
332
#ifdef QT_DEBUG
333
    bool mockPresent  = false;
334
#endif
335 336 337 338 339 340 341 342 343 344
    QSettings settings;
    // Is the group even there?
    if(settings.contains(LinkConfiguration::settingsRoot() + "/count")) {
        // Find out how many configurations we have
        int count = settings.value(LinkConfiguration::settingsRoot() + "/count").toInt();
        for(int i = 0; i < count; i++) {
            QString root(LinkConfiguration::settingsRoot());
            root += QString("/Link%1").arg(i);
            if(settings.contains(root + "/type")) {
                int type = settings.value(root + "/type").toInt();
345
                if((LinkConfiguration::LinkType)type < LinkConfiguration::TypeLast) {
346 347 348 349
                    if(settings.contains(root + "/name")) {
                        QString name = settings.value(root + "/name").toString();
                        if(!name.isEmpty()) {
                            LinkConfiguration* pLink = NULL;
350 351
                            bool autoConnect = settings.value(root + "/auto").toBool();
                            switch((LinkConfiguration::LinkType)type) {
dogmaphobic's avatar
dogmaphobic committed
352
#ifndef __ios__
353 354 355
                                case LinkConfiguration::TypeSerial:
                                    pLink = (LinkConfiguration*)new SerialConfiguration(name);
                                    break;
dogmaphobic's avatar
dogmaphobic committed
356
#endif
357 358 359
                                case LinkConfiguration::TypeUdp:
                                    pLink = (LinkConfiguration*)new UDPConfiguration(name);
                                    break;
360 361 362
                                case LinkConfiguration::TypeTcp:
                                    pLink = (LinkConfiguration*)new TCPConfiguration(name);
                                    break;
dogmaphobic's avatar
dogmaphobic committed
363
#ifdef QGC_ENABLE_BLUETOOTH
dogmaphobic's avatar
dogmaphobic committed
364 365 366 367
                                case LinkConfiguration::TypeBluetooth:
                                    pLink = (LinkConfiguration*)new BluetoothConfiguration(name);
                                    break;
#endif
dogmaphobic's avatar
dogmaphobic committed
368
#ifndef __mobile__
Don Gagne's avatar
Don Gagne committed
369 370 371
                                case LinkConfiguration::TypeLogReplay:
                                    pLink = (LinkConfiguration*)new LogReplayLinkConfiguration(name);
                                    break;
dogmaphobic's avatar
dogmaphobic committed
372
#endif
373
#ifdef QT_DEBUG
374 375
                                case LinkConfiguration::TypeMock:
                                    pLink = (LinkConfiguration*)new MockConfiguration(name);
376
                                    mockPresent = true;
377
                                    break;
378
#endif
379 380 381
                                default:
                                case LinkConfiguration::TypeLast:
                                    break;
382 383
                            }
                            if(pLink) {
384 385
                                //-- Have the instance load its own values
                                pLink->setAutoConnect(autoConnect);
386
                                pLink->loadSettings(settings, root);
Don Gagne's avatar
Don Gagne committed
387
                                _linkConfigurations.append(pLink);
388
                                linksChanged = true;
389 390
                            }
                        } else {
391
                            qWarning() << "Link Configuration" << root << "has an empty name." ;
392 393
                        }
                    } else {
394
                        qWarning() << "Link Configuration" << root << "has no name." ;
395 396
                    }
                } else {
397
                    qWarning() << "Link Configuration" << root << "an invalid type: " << type;
398 399
                }
            } else {
400
                qWarning() << "Link Configuration" << root << "has no type." ;
401 402 403
            }
        }
    }
404
    // Debug buids always add MockLink automatically (if one is not already there)
405
#ifdef QT_DEBUG
406 407 408 409 410 411 412
    if(!mockPresent)
    {
        MockConfiguration* pMock = new MockConfiguration("Mock Link PX4");
        pMock->setDynamic(true);
        _linkConfigurations.append(pMock);
        linksChanged = true;
    }
413
#endif
414 415

    if(linksChanged) {
416
        emit linkConfigurationsChanged();
417 418
    }
    // Enable automatic Serial PX4/3DR Radio hunting
419 420 421
    _configurationsLoaded = true;
}

dogmaphobic's avatar
dogmaphobic committed
422
#ifndef __ios__
Don Gagne's avatar
Don Gagne committed
423
SerialConfiguration* LinkManager::_autoconnectConfigurationsContainsPort(const QString& portName)
424 425
{
    QString searchPort = portName.trimmed();
Don Gagne's avatar
Don Gagne committed
426 427 428 429 430 431 432

    for (int i=0; i<_autoconnectConfigurations.count(); i++) {
        SerialConfiguration* linkConfig = _autoconnectConfigurations.value<SerialConfiguration*>(i);

        if (linkConfig) {
            if (linkConfig->portName() == searchPort) {
                return linkConfig;
433
            }
Don Gagne's avatar
Don Gagne committed
434 435
        } else {
            qWarning() << "Internal error";
436 437 438 439
        }
    }
    return NULL;
}
dogmaphobic's avatar
dogmaphobic committed
440
#endif
441

Don Gagne's avatar
Don Gagne committed
442
void LinkManager::_updateAutoConnectLinks(void)
443
{
Don Gagne's avatar
Don Gagne committed
444
    if (_connectionsSuspended || qgcApp()->runningUnitTests()) {
445 446
        return;
    }
Don Gagne's avatar
Don Gagne committed
447

Don Gagne's avatar
Don Gagne committed
448 449 450 451 452 453 454 455 456 457
    // Re-add UDP if we need to
    bool foundUDP = false;
    for (int i=0; i<_links.count(); i++) {
        LinkConfiguration* linkConfig = _links.value<LinkInterface*>(i)->getLinkConfiguration();
        if (linkConfig->type() == LinkConfiguration::TypeUdp && linkConfig->name() == _defaultUPDLinkName) {
            foundUDP = true;
            break;
        }
    }
    if (!foundUDP) {
Don Gagne's avatar
Don Gagne committed
458
        qCDebug(LinkManagerLog) << "New auto-connect UDP port added";
Don Gagne's avatar
Don Gagne committed
459 460 461
        UDPConfiguration* udpConfig = new UDPConfiguration(_defaultUPDLinkName);
        udpConfig->setLocalPort(QGC_UDP_LOCAL_PORT);
        udpConfig->setDynamic(true);
462
        _linkConfigurations.append(udpConfig);
Don Gagne's avatar
Don Gagne committed
463
        createConnectedLink(udpConfig);
464
        emit linkConfigurationsChanged();
Don Gagne's avatar
Don Gagne committed
465 466
    }

467
#ifndef __ios__
dogmaphobic's avatar
dogmaphobic committed
468
    QStringList currentPorts;
Don Gagne's avatar
Don Gagne committed
469
    QList<QGCSerialPortInfo> portList = QGCSerialPortInfo::availablePorts();
Don Gagne's avatar
Don Gagne committed
470

471
    // Iterate Comm Ports
Don Gagne's avatar
Don Gagne committed
472
    foreach (QGCSerialPortInfo portInfo, portList) {
Don Gagne's avatar
Don Gagne committed
473 474 475 476 477 478 479 480 481
        qCDebug(LinkManagerVerboseLog) << "-----------------------------------------------------";
        qCDebug(LinkManagerVerboseLog) << "portName:          " << portInfo.portName();
        qCDebug(LinkManagerVerboseLog) << "systemLocation:    " << portInfo.systemLocation();
        qCDebug(LinkManagerVerboseLog) << "description:       " << portInfo.description();
        qCDebug(LinkManagerVerboseLog) << "manufacturer:      " << portInfo.manufacturer();
        qCDebug(LinkManagerVerboseLog) << "serialNumber:      " << portInfo.serialNumber();
        qCDebug(LinkManagerVerboseLog) << "vendorIdentifier:  " << portInfo.vendorIdentifier();
        qCDebug(LinkManagerVerboseLog) << "productIdentifier: " << portInfo.productIdentifier();

dogmaphobic's avatar
dogmaphobic committed
482 483
        // Save port name
        currentPorts << portInfo.systemLocation();
Don Gagne's avatar
Don Gagne committed
484 485 486 487 488 489

        QGCSerialPortInfo::BoardType_t boardType = portInfo.boardType();

        if (boardType != QGCSerialPortInfo::BoardTypeUnknown) {
            if (portInfo.isBootloader()) {
                // Don't connect to bootloader
490
                qCDebug(LinkManagerLog) << "Waiting for bootloader to finish" << portInfo.systemLocation();
Don Gagne's avatar
Don Gagne committed
491 492
                continue;
            }
493

494 495 496 497 498 499 500
            if (_autoconnectConfigurationsContainsPort(portInfo.systemLocation())) {
                qCDebug(LinkManagerVerboseLog) << "Skipping existing autoconnect" << portInfo.systemLocation();
            } else if (!_autoconnectWaitList.contains(portInfo.systemLocation())) {
                // We don't connect to the port the first time we see it. The ability to correctly detect whether we
                // are in the bootloader is flaky from a cross-platform standpoint. So by putting it on a wait list
                // and only connect on the second pass we leave enough time for the board to boot up.
                qCDebug(LinkManagerLog) << "Waiting for next autoconnect pass" << portInfo.systemLocation();
501 502
                _autoconnectWaitList[portInfo.systemLocation()] = 1;
            } else if (++_autoconnectWaitList[portInfo.systemLocation()] * _autoconnectUpdateTimerMSecs > _autoconnectConnectDelayMSecs) {
Don Gagne's avatar
Don Gagne committed
503 504
                SerialConfiguration* pSerialConfig = NULL;

505
                _autoconnectWaitList.remove(portInfo.systemLocation());
506

Don Gagne's avatar
Don Gagne committed
507 508 509
                switch (boardType) {
                case QGCSerialPortInfo::BoardTypePX4FMUV1:
                case QGCSerialPortInfo::BoardTypePX4FMUV2:
510
                case QGCSerialPortInfo::BoardTypePX4FMUV4:
Don Gagne's avatar
Don Gagne committed
511 512 513
                    if (_autoconnectPixhawk) {
                        pSerialConfig = new SerialConfiguration(QString("Pixhawk on %1").arg(portInfo.portName().trimmed()));
                    }
Don Gagne's avatar
Don Gagne committed
514 515
                    break;
                case QGCSerialPortInfo::BoardTypeAeroCore:
Don Gagne's avatar
Don Gagne committed
516 517 518
                    if (_autoconnectPixhawk) {
                        pSerialConfig = new SerialConfiguration(QString("AeroCore on %1").arg(portInfo.portName().trimmed()));
                    }
Don Gagne's avatar
Don Gagne committed
519 520
                    break;
                case QGCSerialPortInfo::BoardTypePX4Flow:
Don Gagne's avatar
Don Gagne committed
521 522 523
                    if (_autoconnectPX4Flow) {
                        pSerialConfig = new SerialConfiguration(QString("PX4Flow on %1").arg(portInfo.portName().trimmed()));
                    }
Don Gagne's avatar
Don Gagne committed
524 525
                    break;
                case QGCSerialPortInfo::BoardType3drRadio:
Don Gagne's avatar
Don Gagne committed
526 527 528 529
                    if (_autoconnect3DRRadio) {
                        pSerialConfig = new SerialConfiguration(QString("3DR Radio on %1").arg(portInfo.portName().trimmed()));
                    }
                    break;
Don Gagne's avatar
Don Gagne committed
530 531
                default:
                    qWarning() << "Internal error";
Don Gagne's avatar
Don Gagne committed
532
                    continue;
dogmaphobic's avatar
dogmaphobic committed
533
                }
Don Gagne's avatar
Don Gagne committed
534

Don Gagne's avatar
Don Gagne committed
535 536 537 538 539 540
                if (pSerialConfig) {
                    qCDebug(LinkManagerLog) << "New auto-connect port added: " << pSerialConfig->name() << portInfo.systemLocation();
                    pSerialConfig->setBaud(boardType == QGCSerialPortInfo::BoardType3drRadio ? 57600 : 115200);
                    pSerialConfig->setDynamic(true);
                    pSerialConfig->setPortName(portInfo.systemLocation());
                    _autoconnectConfigurations.append(pSerialConfig);
Don Gagne's avatar
Don Gagne committed
541
                    createConnectedLink(pSerialConfig);
Don Gagne's avatar
Don Gagne committed
542
                }
dogmaphobic's avatar
dogmaphobic committed
543 544 545
            }
        }
    }
Don Gagne's avatar
Don Gagne committed
546

dogmaphobic's avatar
dogmaphobic committed
547 548
    // Now we go through the current configuration list and make sure any dynamic config has gone away
    QList<LinkConfiguration*>  _confToDelete;
Don Gagne's avatar
Don Gagne committed
549 550 551 552
    for (int i=0; i<_autoconnectConfigurations.count(); i++) {
        SerialConfiguration* linkConfig = _autoconnectConfigurations.value<SerialConfiguration*>(i);
        if (linkConfig) {
            if (!currentPorts.contains(linkConfig->portName())) {
Don Gagne's avatar
Don Gagne committed
553 554 555 556 557 558 559
                // We don't remove links which are still connected even though at this point the cable may
                // have been pulled. This is due to the fact that whether a serial port goes away from the
                // list when the cable is pulled is OS dependant. By not disconnecting in this case, we keep
                // things working the same across all OS.
                if (!linkConfig->link() || !linkConfig->link()->isConnected()) {
                    _confToDelete.append(linkConfig);
                }
dogmaphobic's avatar
dogmaphobic committed
560
            }
Don Gagne's avatar
Don Gagne committed
561 562
        } else {
            qWarning() << "Internal error";
dogmaphobic's avatar
dogmaphobic committed
563 564
        }
    }
Don Gagne's avatar
Don Gagne committed
565

Don Gagne's avatar
Don Gagne committed
566
    // Now remove all configs that are gone
Don Gagne's avatar
Don Gagne committed
567
    foreach (LinkConfiguration* pDeleteConfig, _confToDelete) {
Don Gagne's avatar
Don Gagne committed
568
        qCDebug(LinkManagerLog) << "Removing unused autoconnect config" << pDeleteConfig->name();
Don Gagne's avatar
Don Gagne committed
569 570
        _autoconnectConfigurations.removeOne(pDeleteConfig);
        delete pDeleteConfig;
571
    }
572
#endif // __ios__
573 574
}

Don Gagne's avatar
Don Gagne committed
575 576 577 578 579 580 581 582 583 584 585 586 587 588 589
bool LinkManager::anyConnectedLinks(void)
{
    bool found = false;
    for (int i=0; i<_links.count(); i++) {
        LinkInterface* link = _links.value<LinkInterface*>(i);

        if (link && link->isConnected()) {
            found = true;
            break;
        }
    }
    return found;
}

bool LinkManager::anyActiveLinks(void)
590 591
{
    bool found = false;
Don Gagne's avatar
Don Gagne committed
592 593 594 595
    for (int i=0; i<_links.count(); i++) {
        LinkInterface* link = _links.value<LinkInterface*>(i);

        if (link && link->active()) {
596 597 598 599 600 601 602
            found = true;
            break;
        }
    }
    return found;
}

Don Gagne's avatar
Don Gagne committed
603 604 605 606 607 608 609 610 611 612 613
void LinkManager::_vehicleHeartbeatInfo(LinkInterface* link, int vehicleId, int vehicleMavlinkVersion, int vehicleFirmwareType, int vehicleType)
{
    if (!link->active() && !_ignoreVehicleIds.contains(vehicleId)) {
        qCDebug(LinkManagerLog) << "New heartbeat on link:vehicleId:vehicleMavlinkVersion:vehicleFirmwareType:vehicleType "
                                << link->getName()
                                << vehicleId
                                << vehicleMavlinkVersion
                                << vehicleFirmwareType
                                << vehicleType;

        if (vehicleId == _mavlinkProtocol->getSystemId()) {
614
            _app->showMessage(QString("Warning: A vehicle is using the same system id as QGroundControl: %1").arg(vehicleId));
Don Gagne's avatar
Don Gagne committed
615 616 617 618 619 620
        }

        QSettings settings;
        bool mavlinkVersionCheck = settings.value("VERSION_CHECK_ENABLED", true).toBool();
        if (mavlinkVersionCheck && vehicleMavlinkVersion != MAVLINK_VERSION) {
            _ignoreVehicleIds += vehicleId;
621
            _app->showMessage(QString("The MAVLink protocol version on vehicle #%1 and QGroundControl differ! "
Don Gagne's avatar
Don Gagne committed
622 623 624 625 626 627 628 629 630 631 632 633
                                                 "It is unsafe to use different MAVLink versions. "
                                                 "QGroundControl therefore refuses to connect to vehicle #%1, which sends MAVLink version %2 (QGroundControl uses version %3).").arg(vehicleId).arg(vehicleMavlinkVersion).arg(MAVLINK_VERSION));
            return;
        }

        bool previousAnyActiveLinks = anyActiveLinks();

        link->setActive(true);
        emit linkActive(link, vehicleId, vehicleFirmwareType, vehicleType);

        if (!previousAnyActiveLinks) {
            emit anyActiveLinksChanged(true);
634
        }
Don Gagne's avatar
Don Gagne committed
635 636 637 638 639 640
    }
}

void LinkManager::shutdown(void)
{
    setConnectionsSuspended("Shutdown");
Don Gagne's avatar
Don Gagne committed
641
    disconnectAll();
Don Gagne's avatar
Don Gagne committed
642 643 644 645 646 647 648 649 650 651 652 653
}

void LinkManager::setAutoconnectUDP(bool autoconnect)
{
    if (_autoconnectUDP != autoconnect) {
        QSettings settings;

        settings.beginGroup(_settingsGroup);
        settings.setValue(_autoconnectUDPKey, autoconnect);

        _autoconnectUDP = autoconnect;
        emit autoconnectUDPChanged(autoconnect);
654
    }
Don Gagne's avatar
Don Gagne committed
655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696
}

void LinkManager::setAutoconnectPixhawk(bool autoconnect)
{
    if (_autoconnectPixhawk != autoconnect) {
        QSettings settings;

        settings.beginGroup(_settingsGroup);
        settings.setValue(_autoconnectPixhawkKey, autoconnect);

        _autoconnectPixhawk = autoconnect;
        emit autoconnectPixhawkChanged(autoconnect);
    }

}

void LinkManager::setAutoconnect3DRRadio(bool autoconnect)
{
    if (_autoconnect3DRRadio != autoconnect) {
        QSettings settings;

        settings.beginGroup(_settingsGroup);
        settings.setValue(_autoconnect3DRRadioKey, autoconnect);

        _autoconnect3DRRadio = autoconnect;
        emit autoconnect3DRRadioChanged(autoconnect);
    }

}

void LinkManager::setAutoconnectPX4Flow(bool autoconnect)
{
    if (_autoconnectPX4Flow != autoconnect) {
        QSettings settings;

        settings.beginGroup(_settingsGroup);
        settings.setValue(_autoconnectPX4FlowKey, autoconnect);

        _autoconnectPX4Flow = autoconnect;
        emit autoconnectPX4FlowChanged(autoconnect);
    }

697
}
698 699 700 701 702 703 704 705 706 707 708 709

QStringList LinkManager::linkTypeStrings(void) const
{
    //-- Must follow same order as enum LinkType in LinkConfiguration.h
    static QStringList list;
    if(!list.size())
    {
#ifndef __ios__
        list += "Serial";
#endif
        list += "UDP";
        list += "TCP";
dogmaphobic's avatar
dogmaphobic committed
710
#ifdef QGC_ENABLE_BLUETOOTH
dogmaphobic's avatar
dogmaphobic committed
711 712
        list += "Bluetooth";
#endif
dogmaphobic's avatar
dogmaphobic committed
713
#ifdef QT_DEBUG
714
        list += "Mock Link";
dogmaphobic's avatar
dogmaphobic committed
715 716
#endif
#ifndef __mobile__
717
        list += "Log Replay";
dogmaphobic's avatar
dogmaphobic committed
718
#endif
dogmaphobic's avatar
dogmaphobic committed
719
        Q_ASSERT(list.size() == (int)LinkConfiguration::TypeLast);
720 721 722 723
    }
    return list;
}

724
void LinkManager::_updateSerialPorts()
725
{
726 727
    _commPortList.clear();
    _commPortDisplayList.clear();
728
#ifndef __ios__
729 730
    QList<QSerialPortInfo> portList = QSerialPortInfo::availablePorts();
    foreach (const QSerialPortInfo &info, portList)
731
    {
732 733 734
        QString port = info.systemLocation().trimmed();
        _commPortList += port;
        _commPortDisplayList += SerialConfiguration::cleanPortDisplayname(port);
735 736
    }
#endif
737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753
}

QStringList LinkManager::serialPortStrings(void)
{
    if(!_commPortDisplayList.size())
    {
        _updateSerialPorts();
    }
    return _commPortDisplayList;
}

QStringList LinkManager::serialPorts(void)
{
    if(!_commPortList.size())
    {
        _updateSerialPorts();
    }
754 755 756 757 758 759 760 761 762 763 764 765
    return _commPortList;
}

QStringList LinkManager::serialBaudRates(void)
{
#ifdef __ios__
    QStringList foo;
    return foo;
#else
    return SerialConfiguration::supportedBaudRates();
#endif
}
766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791

bool LinkManager::endConfigurationEditing(LinkConfiguration* config, LinkConfiguration* editedConfig)
{
    Q_ASSERT(config != NULL);
    Q_ASSERT(editedConfig != NULL);
    _fixUnnamed(editedConfig);
    config->copyFrom(editedConfig);
    saveLinkConfigurationList();
    // Tell link about changes (if any)
    config->updateSettings();
    // Discard temporary duplicate
    delete editedConfig;
    return true;
}

bool LinkManager::endCreateConfiguration(LinkConfiguration* config)
{
    Q_ASSERT(config != NULL);
    _fixUnnamed(config);
    _linkConfigurations.append(config);
    saveLinkConfigurationList();
    return true;
}

LinkConfiguration* LinkManager::createConfiguration(int type, const QString& name)
{
dogmaphobic's avatar
dogmaphobic committed
792
#ifndef __ios__
793 794
    if((LinkConfiguration::LinkType)type == LinkConfiguration::TypeSerial)
        _updateSerialPorts();
dogmaphobic's avatar
dogmaphobic committed
795
#endif
796 797 798 799 800 801
    return LinkConfiguration::createSettings(type, name);
}

LinkConfiguration* LinkManager::startConfigurationEditing(LinkConfiguration* config)
{
    Q_ASSERT(config != NULL);
dogmaphobic's avatar
dogmaphobic committed
802
#ifndef __ios__
803 804
    if(config->type() == LinkConfiguration::TypeSerial)
        _updateSerialPorts();
dogmaphobic's avatar
dogmaphobic committed
805
#endif
806 807 808 809 810 811 812 813 814 815 816 817 818
    return LinkConfiguration::duplicateSettings(config);
}


void LinkManager::_fixUnnamed(LinkConfiguration* config)
{
    Q_ASSERT(config != NULL);
    //-- Check for "Unnamed"
    if (config->name() == "Unnamed") {
        switch(config->type()) {
#ifndef __ios__
            case LinkConfiguration::TypeSerial: {
                QString tname = dynamic_cast<SerialConfiguration*>(config)->portName();
819
#ifdef Q_OS_WIN
820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840
                tname.replace("\\\\.\\", "");
#else
                tname.replace("/dev/cu.", "");
                tname.replace("/dev/", "");
#endif
                config->setName(QString("Serial Device on %1").arg(tname));
                break;
                }
#endif
            case LinkConfiguration::TypeUdp:
                config->setName(
                    QString("UDP Link on Port %1").arg(dynamic_cast<UDPConfiguration*>(config)->localPort()));
                break;
            case LinkConfiguration::TypeTcp: {
                    TCPConfiguration* tconfig = dynamic_cast<TCPConfiguration*>(config);
                    if(tconfig) {
                        config->setName(
                            QString("TCP Link %1:%2").arg(tconfig->address().toString()).arg((int)tconfig->port()));
                    }
                }
                break;
dogmaphobic's avatar
dogmaphobic committed
841
#ifdef QGC_ENABLE_BLUETOOTH
dogmaphobic's avatar
dogmaphobic committed
842 843 844
            case LinkConfiguration::TypeBluetooth: {
                    BluetoothConfiguration* tconfig = dynamic_cast<BluetoothConfiguration*>(config);
                    if(tconfig) {
845
                        config->setName(QString("%1 (Bluetooth Device)").arg(tconfig->device().name));
dogmaphobic's avatar
dogmaphobic committed
846 847 848 849
                    }
                }
                break;
#endif
dogmaphobic's avatar
dogmaphobic committed
850
#ifndef __mobile__
851
            case LinkConfiguration::TypeLogReplay: {
dogmaphobic's avatar
dogmaphobic committed
852 853 854 855
                    LogReplayLinkConfiguration* tconfig = dynamic_cast<LogReplayLinkConfiguration*>(config);
                    if(tconfig) {
                        config->setName(QString("Log Replay %1").arg(tconfig->logFilenameShort()));
                    }
856 857
                }
                break;
dogmaphobic's avatar
dogmaphobic committed
858
#endif
859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884
#ifdef QT_DEBUG
            case LinkConfiguration::TypeMock:
                config->setName(
                    QString("Mock Link"));
                break;
#endif
            case LinkConfiguration::TypeLast:
            default:
                break;
        }
    }
}

void LinkManager::removeConfiguration(LinkConfiguration* config)
{
    Q_ASSERT(config != NULL);
    LinkInterface* iface = config->link();
    if(iface) {
        disconnectLink(iface);
    }
    // Remove configuration
    _linkConfigurations.removeOne(config);
    delete config;
    // Save list
    saveLinkConfigurationList();
}
885

886 887 888 889
bool LinkManager::isAutoconnectLink(LinkInterface* link)
{
    return _autoconnectConfigurations.contains(link->getLinkConfiguration());
}
dogmaphobic's avatar
dogmaphobic committed
890 891 892 893 894

bool LinkManager::isBluetoothAvailable(void)
{
    return qgcApp()->isBluetoothAvailable();
}