LinkManager.cc 30.5 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 41
#include "LinkManager.h"
#include "MainWindow.h"
42
#include "QGCApplication.h"
43
#include "QGCApplication.h"
Don Gagne's avatar
Don Gagne committed
44 45
#include "UDPLink.h"
#include "TCPLink.h"
46
#ifdef __mobile__
dogmaphobic's avatar
dogmaphobic committed
47 48
#include "BluetoothLink.h"
#endif
49

Don Gagne's avatar
Don Gagne committed
50
QGC_LOGGING_CATEGORY(LinkManagerLog, "LinkManagerLog")
Don Gagne's avatar
Don Gagne committed
51 52 53 54 55 56 57
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
58
const char* LinkManager::_defaultUPDLinkName =      "Default UDP Link";
59

60 61 62 63 64 65 66 67
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

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

pixhawk's avatar
pixhawk committed
80
{
Don Gagne's avatar
Don Gagne committed
81 82 83 84 85
    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;
86

Don Gagne's avatar
Don Gagne committed
87 88 89 90 91
    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
92 93 94 95
}

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

101 102 103 104 105
void LinkManager::setToolbox(QGCToolbox *toolbox)
{
   QGCTool::setToolbox(toolbox);

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

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

111 112
}

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

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

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

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

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

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

192 193
    // MainWindow may be around when doing things like running unit tests
    if (MainWindow::instance()) {
194
        connect(link, &LinkInterface::communicationError, _app, &QGCApplication::criticalMessageBoxOnMainThread);
195
    }
196

197 198 199 200
    connect(link, &LinkInterface::bytesReceived,    _mavlinkProtocol, &MAVLinkProtocol::receiveBytes);
    connect(link, &LinkInterface::connected,        _mavlinkProtocol, &MAVLinkProtocol::linkConnected);
    connect(link, &LinkInterface::disconnected,     _mavlinkProtocol, &MAVLinkProtocol::linkDisconnected);
    _mavlinkProtocol->resetMetadataForLink(link);
201

202
    connect(link, &LinkInterface::connected,    this, &LinkManager::_linkConnected);
203
    connect(link, &LinkInterface::disconnected, this, &LinkManager::_linkDisconnected);
204
}
pixhawk's avatar
pixhawk committed
205

Don Gagne's avatar
Don Gagne committed
206
void LinkManager::disconnectAll(void)
pixhawk's avatar
pixhawk committed
207
{
Don Gagne's avatar
Don Gagne committed
208 209
    // 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
210
        disconnectLink(_links.value<LinkInterface*>(i));
211
    }
pixhawk's avatar
pixhawk committed
212 213 214 215
}

bool LinkManager::connectLink(LinkInterface* link)
{
216
    Q_ASSERT(link);
217

218 219 220 221
    if (_connectionsSuspendedMsg()) {
        return false;
    }

Don Gagne's avatar
Don Gagne committed
222 223
    bool previousAnyConnectedLinks = anyConnectedLinks();

224
    if (link->_connect()) {
Don Gagne's avatar
Don Gagne committed
225 226 227
        if (!previousAnyConnectedLinks) {
            emit anyConnectedLinksChanged(true);
        }
228 229 230 231
        return true;
    } else {
        return false;
    }
pixhawk's avatar
pixhawk committed
232 233
}

Don Gagne's avatar
Don Gagne committed
234
void LinkManager::disconnectLink(LinkInterface* link)
pixhawk's avatar
pixhawk committed
235
{
236
    Q_ASSERT(link);
Don Gagne's avatar
Don Gagne committed
237

Don Gagne's avatar
Don Gagne committed
238 239
    link->_disconnect();
    LinkConfiguration* config = link->getLinkConfiguration();
240 241 242 243
    if (config) {
        if (_autoconnectConfigurations.contains(config)) {
            config->setLink(NULL);
        }
244
    }
Don Gagne's avatar
Don Gagne committed
245
    _deleteLink(link);
246 247 248 249
    if (_autoconnectConfigurations.contains(config)) {
        _autoconnectConfigurations.removeOne(config);
        delete config;
    }
pixhawk's avatar
pixhawk committed
250 251
}

252
void LinkManager::_deleteLink(LinkInterface* link)
253
{
Don Gagne's avatar
Don Gagne committed
254 255 256 257 258 259 260 261
    if (thread() != QThread::currentThread()) {
        qWarning() << "_deleteLink called from incorrect thread";
        return;
    }

    if (!link) {
        return;
    }
262

263 264
    // Free up the mavlink channel associated with this link
    _mavlinkChannelsUsedBitMask &= ~(1 << link->getMavlinkChannel());
265

Don Gagne's avatar
Don Gagne committed
266 267
    _links.removeOne(link);
    delete link;
268

Don Gagne's avatar
Don Gagne committed
269
    // Emit removal of link
270
    emit linkDeleted(link);
pixhawk's avatar
pixhawk committed
271 272
}

273 274 275 276 277
/// @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) {
278
        qgcApp()->showMessage(QString("Connect not allowed: %1").arg(_connectionsSuspendedReason));
279 280 281 282 283 284 285 286 287 288 289 290
        return true;
    } else {
        return false;
    }
}

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

292 293 294 295 296 297 298 299 300
void LinkManager::_linkConnected(void)
{
    emit linkConnected((LinkInterface*)sender());
}

void LinkManager::_linkDisconnected(void)
{
    emit linkDisconnected((LinkInterface*)sender());
}
301 302 303 304 305 306 307 308 309 310

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

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

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

    if(linksChanged) {
421
        emit linkConfigurationsChanged();
422 423
    }
    // Enable automatic Serial PX4/3DR Radio hunting
424 425 426
    _configurationsLoaded = true;
}

dogmaphobic's avatar
dogmaphobic committed
427
#ifndef __ios__
Don Gagne's avatar
Don Gagne committed
428
SerialConfiguration* LinkManager::_autoconnectConfigurationsContainsPort(const QString& portName)
429 430
{
    QString searchPort = portName.trimmed();
Don Gagne's avatar
Don Gagne committed
431 432 433 434 435 436 437

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

        if (linkConfig) {
            if (linkConfig->portName() == searchPort) {
                return linkConfig;
438
            }
Don Gagne's avatar
Don Gagne committed
439 440
        } else {
            qWarning() << "Internal error";
441 442 443 444
        }
    }
    return NULL;
}
dogmaphobic's avatar
dogmaphobic committed
445
#endif
446

Don Gagne's avatar
Don Gagne committed
447
void LinkManager::_updateAutoConnectLinks(void)
448
{
Don Gagne's avatar
Don Gagne committed
449
    if (_connectionsSuspended || qgcApp()->runningUnitTests()) {
450 451
        return;
    }
Don Gagne's avatar
Don Gagne committed
452

Don Gagne's avatar
Don Gagne committed
453 454 455 456 457 458 459 460 461 462
    // 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
463
        qCDebug(LinkManagerLog) << "New auto-connect UDP port added";
Don Gagne's avatar
Don Gagne committed
464 465 466
        UDPConfiguration* udpConfig = new UDPConfiguration(_defaultUPDLinkName);
        udpConfig->setLocalPort(QGC_UDP_LOCAL_PORT);
        udpConfig->setDynamic(true);
467
        _linkConfigurations.append(udpConfig);
Don Gagne's avatar
Don Gagne committed
468
        createConnectedLink(udpConfig);
469
        emit linkConfigurationsChanged();
Don Gagne's avatar
Don Gagne committed
470 471
    }

472
#ifndef __ios__
dogmaphobic's avatar
dogmaphobic committed
473
    QStringList currentPorts;
Don Gagne's avatar
Don Gagne committed
474
    QList<QGCSerialPortInfo> portList = QGCSerialPortInfo::availablePorts();
Don Gagne's avatar
Don Gagne committed
475

476
    // Iterate Comm Ports
Don Gagne's avatar
Don Gagne committed
477
    foreach (QGCSerialPortInfo portInfo, portList) {
Don Gagne's avatar
Don Gagne committed
478 479 480 481 482 483 484 485 486
        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
487 488
        // Save port name
        currentPorts << portInfo.systemLocation();
Don Gagne's avatar
Don Gagne committed
489 490 491 492 493 494

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

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

499 500 501 502 503 504 505
            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();
506 507
                _autoconnectWaitList[portInfo.systemLocation()] = 1;
            } else if (++_autoconnectWaitList[portInfo.systemLocation()] * _autoconnectUpdateTimerMSecs > _autoconnectConnectDelayMSecs) {
Don Gagne's avatar
Don Gagne committed
508 509
                SerialConfiguration* pSerialConfig = NULL;

510
                _autoconnectWaitList.remove(portInfo.systemLocation());
511

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

Don Gagne's avatar
Don Gagne committed
540 541 542 543 544 545
                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
546
                    createConnectedLink(pSerialConfig);
Don Gagne's avatar
Don Gagne committed
547
                }
dogmaphobic's avatar
dogmaphobic committed
548 549 550
            }
        }
    }
Don Gagne's avatar
Don Gagne committed
551

dogmaphobic's avatar
dogmaphobic committed
552 553
    // 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
554 555 556 557
    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
558 559 560 561 562 563 564
                // 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
565
            }
Don Gagne's avatar
Don Gagne committed
566 567
        } else {
            qWarning() << "Internal error";
dogmaphobic's avatar
dogmaphobic committed
568 569
        }
    }
Don Gagne's avatar
Don Gagne committed
570

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

Don Gagne's avatar
Don Gagne committed
580 581 582 583 584 585 586 587 588 589 590 591 592 593 594
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)
595 596
{
    bool found = false;
Don Gagne's avatar
Don Gagne committed
597 598 599 600
    for (int i=0; i<_links.count(); i++) {
        LinkInterface* link = _links.value<LinkInterface*>(i);

        if (link && link->active()) {
601 602 603 604 605 606 607
            found = true;
            break;
        }
    }
    return found;
}

Don Gagne's avatar
Don Gagne committed
608 609 610 611 612 613 614 615 616 617 618
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()) {
619
            _app->showMessage(QString("Warning: A vehicle is using the same system id as QGroundControl: %1").arg(vehicleId));
Don Gagne's avatar
Don Gagne committed
620 621 622 623 624 625
        }

        QSettings settings;
        bool mavlinkVersionCheck = settings.value("VERSION_CHECK_ENABLED", true).toBool();
        if (mavlinkVersionCheck && vehicleMavlinkVersion != MAVLINK_VERSION) {
            _ignoreVehicleIds += vehicleId;
626
            _app->showMessage(QString("The MAVLink protocol version on vehicle #%1 and QGroundControl differ! "
Don Gagne's avatar
Don Gagne committed
627 628 629 630 631 632 633 634 635 636 637 638
                                                 "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);
639
        }
Don Gagne's avatar
Don Gagne committed
640 641 642 643 644 645
    }
}

void LinkManager::shutdown(void)
{
    setConnectionsSuspended("Shutdown");
Don Gagne's avatar
Don Gagne committed
646
    disconnectAll();
Don Gagne's avatar
Don Gagne committed
647 648 649 650 651 652 653 654 655 656 657 658
}

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

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

        _autoconnectUDP = autoconnect;
        emit autoconnectUDPChanged(autoconnect);
659
    }
Don Gagne's avatar
Don Gagne committed
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 697 698 699 700 701
}

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

702
}
703 704 705 706 707 708 709 710 711 712 713 714

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";
715
#ifdef __mobile__
dogmaphobic's avatar
dogmaphobic committed
716 717
        list += "Bluetooth";
#endif
dogmaphobic's avatar
dogmaphobic committed
718
#ifdef QT_DEBUG
719
        list += "Mock Link";
dogmaphobic's avatar
dogmaphobic committed
720 721
#endif
#ifndef __mobile__
722
        list += "Log Replay";
dogmaphobic's avatar
dogmaphobic committed
723
#endif
dogmaphobic's avatar
dogmaphobic committed
724
        Q_ASSERT(list.size() == (int)LinkConfiguration::TypeLast);
725 726 727 728
    }
    return list;
}

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

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

QStringList LinkManager::serialPorts(void)
{
    if(!_commPortList.size())
    {
        _updateSerialPorts();
    }
759 760 761 762 763 764 765 766 767 768 769 770
    return _commPortList;
}

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

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
797
#ifndef __ios__
798 799
    if((LinkConfiguration::LinkType)type == LinkConfiguration::TypeSerial)
        _updateSerialPorts();
dogmaphobic's avatar
dogmaphobic committed
800
#endif
801 802 803 804 805 806
    return LinkConfiguration::createSettings(type, name);
}

LinkConfiguration* LinkManager::startConfigurationEditing(LinkConfiguration* config)
{
    Q_ASSERT(config != NULL);
dogmaphobic's avatar
dogmaphobic committed
807
#ifndef __ios__
808 809
    if(config->type() == LinkConfiguration::TypeSerial)
        _updateSerialPorts();
dogmaphobic's avatar
dogmaphobic committed
810
#endif
811 812 813 814 815 816 817 818 819 820 821 822 823
    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();
824
#ifdef Q_OS_WIN
825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845
                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;
846
#ifdef __mobile__
dogmaphobic's avatar
dogmaphobic committed
847 848 849
            case LinkConfiguration::TypeBluetooth: {
                    BluetoothConfiguration* tconfig = dynamic_cast<BluetoothConfiguration*>(config);
                    if(tconfig) {
850
                        config->setName(QString("%1 (Bluetooth Device)").arg(tconfig->device().name));
dogmaphobic's avatar
dogmaphobic committed
851 852 853 854
                    }
                }
                break;
#endif
dogmaphobic's avatar
dogmaphobic committed
855
#ifndef __mobile__
856
            case LinkConfiguration::TypeLogReplay: {
dogmaphobic's avatar
dogmaphobic committed
857 858 859 860
                    LogReplayLinkConfiguration* tconfig = dynamic_cast<LogReplayLinkConfiguration*>(config);
                    if(tconfig) {
                        config->setName(QString("Log Replay %1").arg(tconfig->logFilenameShort()));
                    }
861 862
                }
                break;
dogmaphobic's avatar
dogmaphobic committed
863
#endif
864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889
#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();
}
890

891 892 893 894
bool LinkManager::isAutoconnectLink(LinkInterface* link)
{
    return _autoconnectConfigurations.contains(link->getLinkConfiguration());
}