QGCToolBar.cc 26.1 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 23 24 25
/*=====================================================================

QGroundControl Open Source Ground Control Station

(c) 2009 - 2011 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 <QToolButton>
#include <QLabel>
26
#include <QSpacerItem>
27
#include "SerialLink.h"
28 29
#include "QGCToolBar.h"
#include "UASManager.h"
lm's avatar
lm committed
30
#include "MainWindow.h"
31 32 33

QGCToolBar::QGCToolBar(QWidget *parent) :
    QToolBar(parent),
34
    mav(NULL),
lm's avatar
lm committed
35 36 37 38
    changed(true),
    batteryPercent(0),
    batteryVoltage(0),
    wpId(0),
39
    wpDistance(0),
40 41
    altitudeMSL(0),
    altitudeRel(0),
42
    systemArmed(false),
43
    currentLink(NULL),
44
    firstAction(NULL)
45
{
46
    setObjectName("QGCToolBar");
47
    setSizePolicy(QSizePolicy::MinimumExpanding, QSizePolicy::MinimumExpanding);
lm's avatar
lm committed
48

49 50
    // Do not load UI, wait for actions
}
lm's avatar
lm committed
51

52 53 54 55 56 57 58 59 60 61
void QGCToolBar::globalPositionChanged(UASInterface* uas, double lat, double lon, double alt, quint64 usec)
{
    Q_UNUSED(uas);
    Q_UNUSED(lat);
    Q_UNUSED(lon);
    Q_UNUSED(usec);
    altitudeMSL = alt;
    changed = true;
}

62 63 64 65 66 67 68 69
void QGCToolBar::heartbeatTimeout(bool timeout, unsigned int ms)
{
    // set timeout label visible
    if (timeout)
    {
        // Alternate colors to increase visibility
        if ((ms / 1000) % 2 == 0)
        {
70
            toolBarTimeoutLabel->setStyleSheet(QString("QLabel {color: #000; background-color: #FF0037;}"));
71 72 73
        }
        else
        {
74
            toolBarTimeoutLabel->setStyleSheet(QString("QLabel {color: #FFF; background-color: #6B0017;}"));
75 76
        }
        toolBarTimeoutLabel->setText(tr("CONNECTION LOST: %1 s").arg((ms / 1000.0f), 2, 'f', 1, ' '));
77
        toolBarTimeoutAction->setVisible(true);
Lorenz Meier's avatar
Lorenz Meier committed
78 79

        toolBarMessageLabel->hide();
80 81 82 83
    }
    else
    {
        // Check if loss text is present, reset once
84
        if (toolBarTimeoutAction->isVisible())
85
        {
86
            toolBarTimeoutAction->setVisible(false);
Lorenz Meier's avatar
Lorenz Meier committed
87 88

            toolBarMessageLabel->show();
89 90 91
        }
    }
}
lm's avatar
lm committed
92

93 94
void QGCToolBar::createUI()
{
95 96 97 98 99 100
    // CREATE TOOLBAR ITEMS
    // Add internal actions
    // Add MAV widget
    symbolLabel = new QLabel(this);
    addWidget(symbolLabel);

101
    toolBarNameLabel = new QLabel(this);
102 103
    toolBarNameLabel->setToolTip(tr("Currently controlled vehicle"));
    toolBarNameLabel->setAlignment(Qt::AlignCenter);
104
    toolBarNameLabel->setSizePolicy(QSizePolicy::Minimum, QSizePolicy::Minimum);
105 106
    addWidget(toolBarNameLabel);

107
    toolBarTimeoutLabel = new QLabel(this);
108 109
    toolBarTimeoutLabel->setToolTip(tr("System timed out, interval since last message"));
    toolBarTimeoutLabel->setAlignment(Qt::AlignCenter);
110
    toolBarTimeoutLabel->setObjectName("toolBarTimeoutLabel");
111 112
    toolBarTimeoutLabel->setSizePolicy(QSizePolicy::Minimum, QSizePolicy::Minimum);
    toolBarTimeoutAction = addWidget(toolBarTimeoutLabel);
113

114
    toolBarSafetyLabel = new QLabel(this);
115 116 117 118
    toolBarSafetyLabel->setToolTip(tr("Vehicle safety state"));
    toolBarSafetyLabel->setAlignment(Qt::AlignCenter);
    addWidget(toolBarSafetyLabel);

119
    toolBarModeLabel = new QLabel(this);
120
    toolBarModeLabel->setToolTip(tr("Vehicle mode"));
121
    toolBarModeLabel->setObjectName("toolBarModeLabel");
122 123 124
    toolBarModeLabel->setAlignment(Qt::AlignCenter);
    addWidget(toolBarModeLabel);

125
    toolBarStateLabel = new QLabel(this);
126
    toolBarStateLabel->setToolTip(tr("Vehicle state"));
127
    toolBarStateLabel->setObjectName("toolBarStateLabel");
128 129 130 131 132 133 134 135 136 137
    toolBarStateLabel->setAlignment(Qt::AlignCenter);
    addWidget(toolBarStateLabel);

    toolBarBatteryBar = new QProgressBar(this);
    toolBarBatteryBar->setMinimum(0);
    toolBarBatteryBar->setMaximum(100);
    toolBarBatteryBar->setMinimumWidth(20);
    toolBarBatteryBar->setMaximumWidth(100);
    toolBarBatteryBar->setToolTip(tr("Battery charge level"));
    toolBarBatteryBar->setObjectName("toolBarBatteryBar");
138
    toolBarBatteryBar->setSizePolicy(QSizePolicy::Minimum, QSizePolicy::MinimumExpanding);
139 140
    addWidget(toolBarBatteryBar);

141
    toolBarBatteryVoltageLabel = new QLabel(this);
142
    toolBarBatteryVoltageLabel->setToolTip(tr("Battery voltage"));
143
    toolBarBatteryVoltageLabel->setObjectName("toolBarBatteryVoltageLabel");
144 145 146
    toolBarBatteryVoltageLabel->setAlignment(Qt::AlignCenter);
    addWidget(toolBarBatteryVoltageLabel);

147
    toolBarWpLabel = new QLabel(this);
148
    toolBarWpLabel->setToolTip(tr("Current waypoint"));
149
    toolBarWpLabel->setObjectName("toolBarWpLabel");
150 151 152
    toolBarWpLabel->setAlignment(Qt::AlignCenter);
    addWidget(toolBarWpLabel);

153
    toolBarMessageLabel = new QLabel(this);
154
    toolBarMessageLabel->setToolTip(tr("Most recent system message"));
155
    toolBarMessageLabel->setObjectName("toolBarMessageLabel");
156 157 158 159 160 161
    addWidget(toolBarMessageLabel);

    QWidget* spacer = new QWidget();
    spacer->setSizePolicy(QSizePolicy::Expanding, QSizePolicy::Expanding);
    addWidget(spacer);

162 163 164
    portComboBox = new QComboBox(this);
    portComboBox->setToolTip(tr("Choose the COM port to use"));
    portComboBox->setEnabled(true);
165
    portComboBox->setMinimumWidth(100);
166
    addWidget(portComboBox);
167 168 169 170

    baudcomboBox = new QComboBox(this);
    baudcomboBox->setToolTip(tr("Choose what baud rate to use"));
    baudcomboBox->setEnabled(true);
171 172 173 174 175 176 177 178 179 180 181
    baudcomboBox->setMinimumWidth(40);
    baudcomboBox->addItem("9600", 9600);
    baudcomboBox->addItem("14400", 14400);
    baudcomboBox->addItem("19200", 19200);
    baudcomboBox->addItem("38400", 38400);
    baudcomboBox->addItem("57600", 57600);
    baudcomboBox->addItem("115200", 115200);
    baudcomboBox->addItem("230400", 230400);
    baudcomboBox->addItem("460800", 460800);
    baudcomboBox->addItem("921600", 921600);
    baudcomboBox->setCurrentIndex(baudcomboBox->findData(57600));
182 183 184 185
    addWidget(baudcomboBox);



186
    connectButton = new QPushButton(tr("Connect"), this);
187
    connectButton->setObjectName("connectButton");
188 189 190
    connectButton->setToolTip(tr("Connect wireless link to MAV"));
    connectButton->setCheckable(true);
    addWidget(connectButton);
191 192
    connect(connectButton, SIGNAL(clicked(bool)), this, SLOT(connectLink(bool)));

193 194
    resetToolbarUI();

lm's avatar
lm committed
195 196
    // DONE INITIALIZING BUTTONS

197 198 199
    // Set the toolbar to be updated every 2s
    connect(&updateViewTimer, SIGNAL(timeout()), this, SLOT(updateView()));

200
    // Configure the toolbar for the current default UAS
201 202
    setActiveUAS(UASManager::instance()->getActiveUAS());
    connect(UASManager::instance(), SIGNAL(activeUASSet(UASInterface*)), this, SLOT(setActiveUAS(UASInterface*)));
203 204 205 206 207 208 209
    qDebug() << "LINK COUNT" << LinkManager::instance()->getLinks().count();
    // Update label if required
    if (LinkManager::instance()->getSerialLinks().count() < 1) {
        connectButton->setText(tr("New Serial Link"));
        baudcomboBox->hide();
        portComboBox->hide();
    } else {
lm's avatar
lm committed
210

211
        QList<SerialLink*> links = LinkManager::instance()->getSerialLinks();
212

213 214 215 216
        foreach(SerialLink* slink, links)
        {
            addLink(slink);
        }
217 218
    }

219 220 221
    connect(LinkManager::instance(), SIGNAL(newLink(LinkInterface*)), this, SLOT(addLink(LinkInterface*)));
    connect(LinkManager::instance(), SIGNAL(linkRemoved(LinkInterface*)), this, SLOT(removeLink(LinkInterface*)));

222
    loadSettings();
Lorenz Meier's avatar
Lorenz Meier committed
223 224

    changed = false;
225 226
}

227 228 229 230 231 232 233 234 235
/**
 * Reset all the labels and stuff for the toolbar to a pristine state. Done at startup after
 * all UI has been created and also when the last UAS has been deleted.
 **/
void QGCToolBar::resetToolbarUI()
{
    toolBarNameLabel->setText("------");
    toolBarNameLabel->setStyleSheet("");
    toolBarTimeoutLabel->setText(tr("UNCONNECTED"));
236
    //toolBarTimeoutLabel->show();
237 238 239 240 241 242 243 244
    toolBarSafetyLabel->setText("----");
    toolBarModeLabel->setText("------");
    toolBarStateLabel->setText("------");
    toolBarBatteryBar->setValue(0);
    toolBarBatteryBar->setDisabled(true);
    toolBarBatteryVoltageLabel->setText("xx.x V");
    toolBarWpLabel->setText("WP--");
    toolBarMessageLabel->clear();
245 246
    lastSystemMessage = "";
    lastSystemMessageTimeMs = 0;
247 248 249 250
    symbolLabel->setStyleSheet("");
    symbolLabel->clear();
}

Lorenz Meier's avatar
Lorenz Meier committed
251
void QGCToolBar::setPerspectiveChangeActions(const QList<QAction*> &actions)
252
{
Lorenz Meier's avatar
Lorenz Meier committed
253 254
    if (actions.count() > 1)
    {
255
        group = new QButtonGroup(this);
Lorenz Meier's avatar
Lorenz Meier committed
256 257
        group->setExclusive(true);

258
        // Add the first button.
Lorenz Meier's avatar
Lorenz Meier committed
259 260 261 262 263 264
        QToolButton *first = new QToolButton(this);
        first->setIcon(actions.first()->icon());
        first->setText(actions.first()->text());
        first->setToolTip(actions.first()->toolTip());
        first->setToolButtonStyle(Qt::ToolButtonTextBesideIcon);
        first->setCheckable(true);
265

Lorenz Meier's avatar
Lorenz Meier committed
266
        connect(first, SIGNAL(clicked(bool)), actions.first(), SIGNAL(triggered(bool)));
267
        connect(actions.first(),SIGNAL(triggered(bool)),first,SLOT(setChecked(bool)));
268

269
        first->setObjectName("firstAction");
270 271

        //first->setStyleSheet("QToolButton { min-height: 24px; max-height: 24px; min-width: 60px; color: #222222; background-color: qlineargradient(x1: 0, y1: 0, x2: 0, y2: 1, stop: 0 #A2A3A4, stop: 1 #B6B7B8); margin-left: 8px; margin-right: 0px; padding-left: 4px; padding-right: 8px; border-radius: 0px; border : 0px solid blue; border-bottom-left-radius: 6px; border-top-left-radius: 6px; border-left: 1px solid #484848; border-top: 1px solid #484848; border-bottom: 1px solid #484848; } QToolButton:checked { background-color: qlineargradient(x1: 0, y1: 0, x2: 0, y2: 1, stop: 0 #555555, stop: 1 #787878); color: #DDDDDD; }");
Lorenz Meier's avatar
Lorenz Meier committed
272 273 274
        addWidget(first);
        group->addButton(first);

275
        // Add all the middle buttons.
276
        for (int i = 1; i < actions.count(); i++)
Lorenz Meier's avatar
Lorenz Meier committed
277 278 279 280 281 282 283 284
        {
            QToolButton *btn = new QToolButton(this);
            btn->setIcon(actions.at(i)->icon());
            btn->setText(actions.at(i)->text());
            btn->setToolTip(actions.at(i)->toolTip());
            btn->setToolButtonStyle(Qt::ToolButtonTextBesideIcon);
            btn->setCheckable(true);
            connect(btn, SIGNAL(clicked(bool)), actions.at(i), SIGNAL(triggered(bool)));
285
            connect(actions.at(i),SIGNAL(triggered(bool)),btn,SLOT(setChecked(bool)));
Lorenz Meier's avatar
Lorenz Meier committed
286 287 288 289 290
            addWidget(btn);
            group->addButton(btn);
        }

        // Add last button
291
        advancedButton = new QToolButton(this);
292 293 294 295
        advancedButton->setIcon(QIcon(":/files/images/apps/utilities-system-monitor.svg"));
        advancedButton->setText(tr("Pro"));
        advancedButton->setToolTip(tr("Options for advanced users"));
        advancedButton->setCheckable(true);
296
        advancedButton->setObjectName("advancedButton");
297
        advancedButton->setPopupMode(QToolButton::InstantPopup);
298
        advancedButton->setToolButtonStyle(Qt::ToolButtonTextBesideIcon);
299 300
        addWidget(advancedButton);
        group->addButton(advancedButton);
301
    } else {
Lorenz Meier's avatar
Lorenz Meier committed
302
        qDebug() << __FILE__ << __LINE__ << "Not enough perspective change actions provided";
303
    }
Lorenz Meier's avatar
Lorenz Meier committed
304

305
    // Add the "rest"
Lorenz Meier's avatar
Lorenz Meier committed
306
    createUI();
307 308
}

309 310 311 312 313 314 315 316 317 318 319 320 321
void QGCToolBar::setPerspectiveChangeAdvancedActions(const QList<QAction*> &actions)
{
    if (actions.count() > 1)
    {
        QMenu *menu = new QMenu(advancedButton);

        for (int i = 0; i < actions.count(); i++)
        {

            menu->addAction(actions.at(i));
        }

        advancedButton->setMenu(menu);
322
        connect(menu, SIGNAL(triggered(QAction*)), this, SLOT(advancedActivityTriggered(QAction*)));
323 324 325 326 327 328

    } else {
        qDebug() << __FILE__ << __LINE__ << "Not enough perspective change actions provided";
    }
}

329 330 331 332 333 334
void QGCToolBar::advancedActivityTriggered(QAction* action)
{
    if (action->isChecked())
        advancedButton->setChecked(true);
}

335 336
void QGCToolBar::setActiveUAS(UASInterface* active)
{
337
    // Do nothing if system is the same
338 339
    if (mav == active || active == NULL)
        return;
340

341
    // If switching UASes, disconnect the only one.
342 343 344 345 346 347
    if (mav)
    {
        disconnect(mav, SIGNAL(statusChanged(UASInterface*,QString,QString)), this, SLOT(updateState(UASInterface*,QString,QString)));
        disconnect(mav, SIGNAL(modeChanged(int,QString,QString)), this, SLOT(updateMode(int,QString,QString)));
        disconnect(mav, SIGNAL(nameChanged(QString)), this, SLOT(updateName(QString)));
        disconnect(mav, SIGNAL(systemTypeSet(UASInterface*,uint)), this, SLOT(setSystemType(UASInterface*,uint)));
LM's avatar
LM committed
348
        disconnect(mav, SIGNAL(textMessageReceived(int,int,int,QString)), this, SLOT(receiveTextMessage(int,int,int,QString)));
dongfang's avatar
dongfang committed
349
        disconnect(mav, SIGNAL(batteryChanged(UASInterface*, double, double, double,int)), this, SLOT(updateBatteryRemaining(UASInterface*, double, double, double, int)));
350
        disconnect(mav, SIGNAL(armingChanged(bool)), this, SLOT(updateArmingState(bool)));
351
        disconnect(mav, SIGNAL(heartbeatTimeout(bool, unsigned int)), this, SLOT(heartbeatTimeout(bool,unsigned int)));
352
        disconnect(active, SIGNAL(globalPositionChanged(UASInterface*,double,double,double,quint64)), this, SLOT(globalPositionChanged(UASInterface*,double,double,double,quint64)));
353 354
        if (mav->getWaypointManager())
        {
355
            disconnect(mav->getWaypointManager(), SIGNAL(currentWaypointChanged(quint16)), this, SLOT(updateCurrentWaypoint(quint16)));
356 357
            disconnect(mav->getWaypointManager(), SIGNAL(waypointDistanceChanged(double)), this, SLOT(updateWaypointDistance(double)));
        }
358
    }
359 360 361 362 363
    else
    {
        // Only update the UI once a UAS has been selected.
        updateViewTimer.start(2000);
    }
364 365 366

    // Connect new system
    mav = active;
367
    if (mav)
368
    {
369 370 371 372 373
        connect(mav, SIGNAL(statusChanged(UASInterface*,QString,QString)), this, SLOT(updateState(UASInterface*, QString,QString)));
        connect(mav, SIGNAL(modeChanged(int,QString,QString)), this, SLOT(updateMode(int,QString,QString)));
        connect(mav, SIGNAL(nameChanged(QString)), this, SLOT(updateName(QString)));
        connect(mav, SIGNAL(systemTypeSet(UASInterface*,uint)), this, SLOT(setSystemType(UASInterface*,uint)));
        connect(mav, SIGNAL(textMessageReceived(int,int,int,QString)), this, SLOT(receiveTextMessage(int,int,int,QString)));
374
        connect(mav, SIGNAL(batteryChanged(UASInterface*,double,double,double,int)), this, SLOT(updateBatteryRemaining(UASInterface*,double,double,double,int)));
375 376 377 378 379 380 381 382
        connect(mav, SIGNAL(armingChanged(bool)), this, SLOT(updateArmingState(bool)));
        connect(mav, SIGNAL(heartbeatTimeout(bool, unsigned int)), this, SLOT(heartbeatTimeout(bool,unsigned int)));
        connect(mav, SIGNAL(globalPositionChanged(UASInterface*,double,double,double,quint64)), this, SLOT(globalPositionChanged(UASInterface*,double,double,double,quint64)));
        if (mav->getWaypointManager())
        {
            connect(mav->getWaypointManager(), SIGNAL(currentWaypointChanged(quint16)), this, SLOT(updateCurrentWaypoint(quint16)));
            connect(mav->getWaypointManager(), SIGNAL(waypointDistanceChanged(double)), this, SLOT(updateWaypointDistance(double)));
        }
383

384 385 386 387 388 389 390 391
        // Update all values once
        systemName = mav->getUASName();
        systemArmed = mav->isArmed();
        toolBarNameLabel->setText(mav->getUASName());
        toolBarNameLabel->setStyleSheet(QString("QLabel {color: %1;}").arg(mav->getColor().name()));
        symbolLabel->setStyleSheet(QString("QWidget {background-color: %1;}").arg(mav->getColor().name()));
        toolBarModeLabel->setText(mav->getShortMode());
        toolBarStateLabel->setText(mav->getShortState());
392 393 394
        toolBarTimeoutAction->setVisible(false);
        toolBarMessageLabel->clear();
        lastSystemMessageTimeMs = 0;
395 396 397 398 399
        toolBarBatteryBar->setEnabled(true);
        setSystemType(mav, mav->getSystemType());
    }
    else
    {
400 401 402 403 404
        updateViewTimer.stop();
        resetToolbarUI();
    }
}

405 406 407 408
void QGCToolBar::updateArmingState(bool armed)
{
    systemArmed = armed;
    changed = true;
Lorenz Meier's avatar
Lorenz Meier committed
409 410
    /* important, immediately update */
    updateView();
411 412
}

lm's avatar
lm committed
413 414 415 416 417
void QGCToolBar::updateView()
{
    if (!changed) return;
    toolBarWpLabel->setText(tr("WP%1").arg(wpId));
    toolBarBatteryBar->setValue(batteryPercent);
Lorenz Meier's avatar
Lorenz Meier committed
418
    if (batteryPercent < 30 && toolBarBatteryBar->value() >= 30) {
419 420 421 422 423 424 425 426
        if (MainWindow::instance()->getStyle() == MainWindow::QGC_MAINWINDOW_STYLE_LIGHT)
        {
            toolBarBatteryBar->setStyleSheet("QProgressBar {color: #FFF} QProgressBar::chunk { background-color: #008000}");
        }
        else
        {
            toolBarBatteryBar->setStyleSheet("QProgressBar {color: #000} QProgressBar QProgressBar::chunk { background-color: #0F0}");
        }
Lorenz Meier's avatar
Lorenz Meier committed
427
    } else if (batteryPercent >= 30 && toolBarBatteryBar->value() < 30){
428 429 430 431 432 433 434 435
        if (MainWindow::instance()->getStyle() == MainWindow::QGC_MAINWINDOW_STYLE_LIGHT)
        {
            toolBarBatteryBar->setStyleSheet("QProgressBar {color: #FFF} QProgressBar::chunk { background-color: #808000}");
        }
        else
        {
            toolBarBatteryBar->setStyleSheet("QProgressBar {color: #000} QProgressBar QProgressBar::chunk { background-color: #FF0}");
        }
Lorenz Meier's avatar
Lorenz Meier committed
436 437
    }

lm's avatar
lm committed
438
    toolBarBatteryVoltageLabel->setText(tr("%1 V").arg(batteryVoltage, 4, 'f', 1, ' '));
439 440
    toolBarStateLabel->setText(QString("%1").arg(state));
    toolBarModeLabel->setText(QString("%1").arg(mode));
lm's avatar
lm committed
441
    toolBarNameLabel->setText(systemName);
442 443
    // expire after 15 seconds
    if (QGC::groundTimeMilliseconds() - lastSystemMessageTimeMs < 15000) {
444
        toolBarMessageLabel->setText(QString("%1").arg(lastSystemMessage));
445
    } else {
446
        toolBarMessageLabel->clear();
447
    }
448

449
    // Display the system armed state with a red-on-yellow background if armed or green text if safe.
450 451
    if (systemArmed)
    {
452
        toolBarSafetyLabel->setStyleSheet(QString("QLabel {color: %1; background-color: %2; font-size: 15pt;}").arg(QGC::colorRed.name()).arg(QGC::colorYellow.name()));
453 454 455 456
        toolBarSafetyLabel->setText(tr("ARMED"));
    }
    else
    {
457 458
        if (MainWindow::instance()->getStyle() == MainWindow::QGC_MAINWINDOW_STYLE_LIGHT)
        {
459
            toolBarSafetyLabel->setStyleSheet("QLabel {color: #0D820D; font-size: 15pt;}");
460 461 462
        }
        else
        {
463
            toolBarSafetyLabel->setStyleSheet("QLabel {color: #14C814; font-size: 15pt;}");
464
        }
Lorenz Meier's avatar
Lorenz Meier committed
465
        toolBarSafetyLabel->setText(tr("DISARMED"));
466 467
    }

lm's avatar
lm committed
468
    changed = false;
lm's avatar
lm committed
469 470
}

471 472
void QGCToolBar::updateWaypointDistance(double distance)
{
lm's avatar
lm committed
473 474
    if (wpDistance != distance) changed = true;
    wpDistance = distance;
475 476 477 478
}

void QGCToolBar::updateCurrentWaypoint(quint16 id)
{
lm's avatar
lm committed
479
    if (wpId != id) changed = true;
lm's avatar
lm committed
480
    wpId = id;
481 482
}

dongfang's avatar
dongfang committed
483
void QGCToolBar::updateBatteryRemaining(UASInterface* uas, double voltage, double current, double percent, int seconds)
LM's avatar
LM committed
484
{
485 486
    Q_UNUSED(uas);
    Q_UNUSED(seconds);
487
    Q_UNUSED(current);
488

lm's avatar
lm committed
489
    if (batteryPercent != percent || batteryVoltage != voltage) changed = true;
lm's avatar
lm committed
490 491
    batteryPercent = percent;
    batteryVoltage = voltage;
LM's avatar
LM committed
492 493
}

494 495 496 497
void QGCToolBar::updateState(UASInterface* system, QString name, QString description)
{
    Q_UNUSED(system);
    Q_UNUSED(description);
lm's avatar
lm committed
498
    if (state != name) changed = true;
lm's avatar
lm committed
499
    state = name;
Lorenz Meier's avatar
Lorenz Meier committed
500 501
    /* important, immediately update */
    updateView();
502 503 504 505 506 507
}

void QGCToolBar::updateMode(int system, QString name, QString description)
{
    Q_UNUSED(system);
    Q_UNUSED(description);
lm's avatar
lm committed
508 509
    if (mode != name) changed = true;
    mode = name;
Lorenz Meier's avatar
Lorenz Meier committed
510 511
    /* important, immediately update */
    updateView();
512 513 514 515
}

void QGCToolBar::updateName(const QString& name)
{
Lorenz Meier's avatar
Lorenz Meier committed
516 517 518 519
    if (systemName != name)
    {
        changed = true;
    }
lm's avatar
lm committed
520
    systemName = name;
521 522 523 524 525 526 527 528 529 530 531 532
}

/**
 * The current system type is represented through the system icon.
 *
 * @param uas Source system, has to be the same as this->uas
 * @param systemType type ID, following the MAVLink system type conventions
 * @see http://pixhawk.ethz.ch/software/mavlink
 */
void QGCToolBar::setSystemType(UASInterface* uas, unsigned int systemType)
{
    Q_UNUSED(uas);
533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593
    QPixmap newPixmap;
    switch (systemType) {
    case MAV_TYPE_GENERIC:
        newPixmap = QPixmap(":/files/images/mavs/generic.svg");
        break;
    case MAV_TYPE_FIXED_WING:
        newPixmap = QPixmap(":/files/images/mavs/fixed-wing.svg");
        break;
    case MAV_TYPE_QUADROTOR:
        newPixmap = QPixmap(":/files/images/mavs/quadrotor.svg");
        break;
    case MAV_TYPE_COAXIAL:
        newPixmap = QPixmap(":/files/images/mavs/coaxial.svg");
        break;
    case MAV_TYPE_HELICOPTER:
        newPixmap = QPixmap(":/files/images/mavs/helicopter.svg");
        break;
    case MAV_TYPE_ANTENNA_TRACKER:
        newPixmap = QPixmap(":/files/images/mavs/antenna-tracker.svg");
        break;
    case MAV_TYPE_GCS:
        newPixmap = QPixmap(":files/images/mavs/groundstation.svg");
        break;
    case MAV_TYPE_AIRSHIP:
        newPixmap = QPixmap(":files/images/mavs/airship.svg");
        break;
    case MAV_TYPE_FREE_BALLOON:
        newPixmap = QPixmap(":files/images/mavs/free-balloon.svg");
        break;
    case MAV_TYPE_ROCKET:
        newPixmap = QPixmap(":files/images/mavs/rocket.svg");
        break;
    case MAV_TYPE_GROUND_ROVER:
        newPixmap = QPixmap(":files/images/mavs/ground-rover.svg");
        break;
    case MAV_TYPE_SURFACE_BOAT:
        newPixmap = QPixmap(":files/images/mavs/surface-boat.svg");
        break;
    case MAV_TYPE_SUBMARINE:
        newPixmap = QPixmap(":files/images/mavs/submarine.svg");
        break;
    case MAV_TYPE_HEXAROTOR:
        newPixmap = QPixmap(":files/images/mavs/hexarotor.svg");
        break;
    case MAV_TYPE_OCTOROTOR:
        newPixmap = QPixmap(":files/images/mavs/octorotor.svg");
        break;
    case MAV_TYPE_TRICOPTER:
        newPixmap = QPixmap(":files/images/mavs/tricopter.svg");
        break;
    case MAV_TYPE_FLAPPING_WING:
        newPixmap = QPixmap(":files/images/mavs/flapping-wing.svg");
        break;
    case MAV_TYPE_KITE:
        newPixmap = QPixmap(":files/images/mavs/kite.svg");
        break;
    default:
        newPixmap = QPixmap(":/files/images/mavs/unknown.svg");
        break;
    }
    symbolLabel->setPixmap(newPixmap.scaledToHeight(24));
594 595
}

LM's avatar
LM committed
596 597 598 599 600
void QGCToolBar::receiveTextMessage(int uasid, int componentid, int severity, QString text)
{
    Q_UNUSED(uasid);
    Q_UNUSED(componentid);
    Q_UNUSED(severity);
lm's avatar
lm committed
601
    if (lastSystemMessage != text) changed = true;
lm's avatar
lm committed
602
    lastSystemMessage = text;
603
    lastSystemMessageTimeMs = QGC::groundTimeMilliseconds();
LM's avatar
LM committed
604 605
}

606 607
void QGCToolBar::addLink(LinkInterface* link)
{
608 609 610 611 612 613 614 615
    // Accept only serial links as current link
    SerialLink* serial = qobject_cast<SerialLink*>(link);

    if (serial && !currentLink)
    {
        baudcomboBox->show();
        portComboBox->show();

616 617 618
        currentLink = link;
        connect(currentLink, SIGNAL(connected(bool)), this, SLOT(updateLinkState(bool)));
        updateLinkState(link->isConnected());
619 620 621 622

        qDebug() << "ADD LINK";

        updateComboBox();
623 624 625 626 627 628 629
    }
}

void QGCToolBar::removeLink(LinkInterface* link)
{
    if (link == currentLink) {
        currentLink = NULL;
630 631 632 633 634 635 636 637 638

        // Try to get a new serial link
        foreach (SerialLink* s, LinkManager::instance()->getSerialLinks())
        {
            addLink(s);
        }

        // Update GUI according to scan result
        if (currentLink) {
639 640
            updateLinkState(currentLink->isConnected());
        } else {
641 642 643
            connectButton->setText(tr("New Serial Link"));
            portComboBox->hide();
            baudcomboBox->hide();
644 645
        }
    }
646 647 648 649 650
    updateComboBox();
}
void QGCToolBar::updateComboBox()
{
    portComboBox->clear();
651
    if (currentLink)
652
    {
653 654 655 656 657 658 659 660
        SerialLink *slink = qobject_cast<SerialLink*>(currentLink);
        QList<QString> portlist = slink->getCurrentPorts();
        foreach(QString port, portlist) {
            portComboBox->addItem(port, port);
        }

        portComboBox->setCurrentIndex(portComboBox->findData(slink->getPortName()));
        if (slink->getPortName().trimmed().length() > 0)
661
        {
662
            portComboBox->setEditText(slink->getPortName());
663 664 665
        }
        else
        {
666 667 668 669 670 671 672 673
            if (portlist.length() > 0)
            {
                portComboBox->setEditText(portlist.first());
            }
            else
            {
                portComboBox->setEditText(tr("No serial port found"));
            }
674
        }
675
        baudcomboBox->setCurrentIndex(baudcomboBox->findData(slink->getBaudRate()));
676
    }
677 678 679 680
}

void QGCToolBar::updateLinkState(bool connected)
{
681
    Q_UNUSED(connected);
682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697
    if (currentLink && currentLink->isConnected())
    {
        connectButton->setText(tr("Disconnect"));
        connectButton->blockSignals(true);
        connectButton->setChecked(true);
        connectButton->blockSignals(false);
    }
    else
    {
        connectButton->setText(tr("Connect"));
        connectButton->blockSignals(true);
        connectButton->setChecked(false);
        connectButton->blockSignals(false);
    }
}

698 699
void QGCToolBar::connectLink(bool connect)
{
700
    // No serial port yet present
701
    if (connect && LinkManager::instance()->getSerialLinks().count() == 0)
702 703
    {
        MainWindow::instance()->addLink();
704
        currentLink = LinkManager::instance()->getLinks().last();
705
    } else if (connect) {
706 707
        SerialLink *link = qobject_cast<SerialLink*>(currentLink);
        if (link)
708
        {
709
            link->setPortName(portComboBox->itemData(portComboBox->currentIndex()).toString().trimmed());
710 711
            int baud = baudcomboBox->currentText().toInt();
            link->setBaudRate(baud);
712 713
            link->connect();
        }
714 715 716

    } else if (!connect && currentLink) {
        currentLink->disconnect();
717 718 719
    }
}

720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735

void QGCToolBar::loadSettings()
{
    QSettings settings;
    settings.beginGroup("QGC_TOOLBAR");
    settings.endGroup();
}

void QGCToolBar::storeSettings()
{
    QSettings settings;
    settings.beginGroup("QGC_TOOLBAR");
    settings.endGroup();
    settings.sync();
}

736 737
void QGCToolBar::clearStatusString()
{
Lorenz Meier's avatar
Lorenz Meier committed
738 739 740 741 742
    if (toolBarMessageLabel->text().length() > 0)
    {
        lastSystemMessage = "";
        changed = true;
    }
743 744
}

745 746
QGCToolBar::~QGCToolBar()
{
747
    storeSettings();
748
}