QGCToolBar.cc 28.7 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),
35
    userBaudChoice(false),
36
    userPortChoice(false),
lm's avatar
lm committed
37 38 39 40
    changed(true),
    batteryPercent(0),
    batteryVoltage(0),
    wpId(0),
41
    wpDistance(0),
42 43
    altitudeMSL(0),
    altitudeRel(0),
44
    systemArmed(false),
45
    currentLink(NULL),
46
    firstAction(NULL)
47
{
48
    setObjectName("QGCToolBar");
49
    setSizePolicy(QSizePolicy::MinimumExpanding, QSizePolicy::MinimumExpanding);
lm's avatar
lm committed
50

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

54
void QGCToolBar::globalPositionChanged(UASInterface* uas, double lat, double lon, double altAMSL, double altWGS84, quint64 usec)
55 56 57 58
{
    Q_UNUSED(uas);
    Q_UNUSED(lat);
    Q_UNUSED(lon);
59
    Q_UNUSED(altWGS84);
60
    Q_UNUSED(usec);
61
    altitudeMSL = altAMSL;
62 63 64
    changed = true;
}

65 66 67 68 69 70 71 72
void QGCToolBar::heartbeatTimeout(bool timeout, unsigned int ms)
{
    // set timeout label visible
    if (timeout)
    {
        // Alternate colors to increase visibility
        if ((ms / 1000) % 2 == 0)
        {
73
            toolBarTimeoutLabel->setStyleSheet(QString("QLabel {color: #000; background-color: #FF0037;}"));
74 75 76
        }
        else
        {
77
            toolBarTimeoutLabel->setStyleSheet(QString("QLabel {color: #FFF; background-color: #6B0017;}"));
78 79
        }
        toolBarTimeoutLabel->setText(tr("CONNECTION LOST: %1 s").arg((ms / 1000.0f), 2, 'f', 1, ' '));
80
        toolBarTimeoutAction->setVisible(true);
81
        toolBarMessageAction->setVisible(false);
Lorenz Meier's avatar
Lorenz Meier committed
82
        toolBarBatteryBarAction->setVisible(false);
83 84 85 86
    }
    else
    {
        // Check if loss text is present, reset once
87
        if (toolBarTimeoutAction->isVisible())
88
        {
89
            toolBarTimeoutAction->setVisible(false);
90
            toolBarMessageAction->setVisible(true);
Lorenz Meier's avatar
Lorenz Meier committed
91
            toolBarBatteryBarAction->setVisible(true);
92 93 94
        }
    }
}
lm's avatar
lm committed
95

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

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

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

117
    toolBarSafetyLabel = new QLabel(this);
118 119 120 121
    toolBarSafetyLabel->setToolTip(tr("Vehicle safety state"));
    toolBarSafetyLabel->setAlignment(Qt::AlignCenter);
    addWidget(toolBarSafetyLabel);

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

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

    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");
141
    toolBarBatteryBar->setSizePolicy(QSizePolicy::Minimum, QSizePolicy::MinimumExpanding);
Lorenz Meier's avatar
Lorenz Meier committed
142
    toolBarBatteryBarAction = addWidget(toolBarBatteryBar);
143

144
    toolBarBatteryVoltageLabel = new QLabel(this);
145
    toolBarBatteryVoltageLabel->setToolTip(tr("Battery voltage"));
146
    toolBarBatteryVoltageLabel->setObjectName("toolBarBatteryVoltageLabel");
147
    toolBarBatteryVoltageLabel->setAlignment(Qt::AlignCenter);
Lorenz Meier's avatar
Lorenz Meier committed
148
    toolBarBatteryVoltageAction = addWidget(toolBarBatteryVoltageLabel);
149

150
    toolBarWpLabel = new QLabel(this);
151
    toolBarWpLabel->setToolTip(tr("Current waypoint"));
152
    toolBarWpLabel->setObjectName("toolBarWpLabel");
153
    toolBarWpLabel->setAlignment(Qt::AlignCenter);
154
    toolBarWpAction = addWidget(toolBarWpLabel);
155

156
    toolBarMessageLabel = new QLabel(this);
157
    toolBarMessageLabel->setToolTip(tr("Most recent system message"));
158
    toolBarMessageLabel->setObjectName("toolBarMessageLabel");
159
    toolBarMessageAction = addWidget(toolBarMessageLabel);
160 161 162 163 164

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

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

    baudcomboBox = new QComboBox(this);
    baudcomboBox->setToolTip(tr("Choose what baud rate to use"));
    baudcomboBox->setEnabled(true);
174 175 176 177 178 179 180 181 182 183 184
    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));
185
    toolBarBaudAction = addWidget(baudcomboBox);
Lorenz Meier's avatar
Lorenz Meier committed
186 187
    connect(baudcomboBox, SIGNAL(activated(int)), this, SLOT(baudSelected(int)));
    connect(portComboBox, SIGNAL(activated(int)), this, SLOT(portSelected(int)));
188

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

196 197
    resetToolbarUI();

lm's avatar
lm committed
198 199
    // DONE INITIALIZING BUTTONS

200 201 202
    // Set the toolbar to be updated every 2s
    connect(&updateViewTimer, SIGNAL(timeout()), this, SLOT(updateView()));

203
    // Configure the toolbar for the current default UAS
204 205
    setActiveUAS(UASManager::instance()->getActiveUAS());
    connect(UASManager::instance(), SIGNAL(activeUASSet(UASInterface*)), this, SLOT(setActiveUAS(UASInterface*)));
206 207 208
    // Update label if required
    if (LinkManager::instance()->getSerialLinks().count() < 1) {
        connectButton->setText(tr("New Serial Link"));
209 210
        toolBarPortAction->setVisible(false);
        toolBarBaudAction->setVisible(false);
211
    } else {
lm's avatar
lm committed
212

213
        QList<SerialLink*> links = LinkManager::instance()->getSerialLinks();
214

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

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

224
    loadSettings();
Lorenz Meier's avatar
Lorenz Meier committed
225

226 227 228
    connect(&portBoxTimer, SIGNAL(timeout()), this, SLOT(updateComboBox()));
    portBoxTimer.start(500);

229 230 231
    toolBarMessageAction->setVisible(false);
    toolBarBatteryBarAction->setVisible(false);

Lorenz Meier's avatar
Lorenz Meier committed
232
    changed = false;
233 234
}

235 236 237 238 239 240 241 242 243
/**
 * 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"));
244
    //toolBarTimeoutLabel->show();
245 246
    toolBarSafetyLabel->setText("----");
    toolBarModeLabel->setText("------");
247
//    toolBarStateLabel->setText("------");
248 249 250 251 252
    toolBarBatteryBar->setValue(0);
    toolBarBatteryBar->setDisabled(true);
    toolBarBatteryVoltageLabel->setText("xx.x V");
    toolBarWpLabel->setText("WP--");
    toolBarMessageLabel->clear();
253 254
    lastSystemMessage = "";
    lastSystemMessageTimeMs = 0;
255 256
    symbolLabel->setStyleSheet("");
    symbolLabel->clear();
257 258
    toolBarMessageAction->setVisible(false);
    toolBarBatteryBarAction->setVisible(false);
259 260
}

261 262
void QGCToolBar::baudSelected(int index)
{
263
    Q_UNUSED(index);
264 265 266
    userBaudChoice = true;
}

267 268 269 270 271 272
void QGCToolBar::portSelected(int index)
{
    Q_UNUSED(index);
    userPortChoice = true;
}

Lorenz Meier's avatar
Lorenz Meier committed
273
void QGCToolBar::setPerspectiveChangeActions(const QList<QAction*> &actions)
274
{
Lorenz Meier's avatar
Lorenz Meier committed
275 276
    if (actions.count() > 1)
    {
277
        group = new QButtonGroup(this);
Lorenz Meier's avatar
Lorenz Meier committed
278 279
        group->setExclusive(true);

280
        // Add the first button.
Lorenz Meier's avatar
Lorenz Meier committed
281 282 283 284 285 286
        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);
287

Lorenz Meier's avatar
Lorenz Meier committed
288
        connect(first, SIGNAL(clicked(bool)), actions.first(), SIGNAL(triggered(bool)));
289
        connect(actions.first(),SIGNAL(triggered(bool)),first,SLOT(setChecked(bool)));
290

291
        first->setObjectName("firstAction");
292 293

        //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
294 295 296
        addWidget(first);
        group->addButton(first);

297
        // Add all the middle buttons.
298
        for (int i = 1; i < actions.count(); i++)
Lorenz Meier's avatar
Lorenz Meier committed
299 300 301 302 303 304 305 306
        {
            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)));
307
            connect(actions.at(i),SIGNAL(triggered(bool)),btn,SLOT(setChecked(bool)));
Lorenz Meier's avatar
Lorenz Meier committed
308 309 310 311 312
            addWidget(btn);
            group->addButton(btn);
        }

        // Add last button
313
        advancedButton = new QToolButton(this);
314 315 316 317
        advancedButton->setIcon(QIcon(":/files/images/apps/utilities-system-monitor.svg"));
        advancedButton->setText(tr("Pro"));
        advancedButton->setToolTip(tr("Options for advanced users"));
        advancedButton->setCheckable(true);
318
        advancedButton->setObjectName("advancedButton");
319
        advancedButton->setPopupMode(QToolButton::InstantPopup);
320
        advancedButton->setToolButtonStyle(Qt::ToolButtonTextBesideIcon);
321 322
        addWidget(advancedButton);
        group->addButton(advancedButton);
323
    } else {
Lorenz Meier's avatar
Lorenz Meier committed
324
        qDebug() << __FILE__ << __LINE__ << "Not enough perspective change actions provided";
325
    }
Lorenz Meier's avatar
Lorenz Meier committed
326

327
    // Add the "rest"
Lorenz Meier's avatar
Lorenz Meier committed
328
    createUI();
329 330
}

331 332 333 334 335 336 337 338 339 340 341 342 343
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);
344
        connect(menu, SIGNAL(triggered(QAction*)), this, SLOT(advancedActivityTriggered(QAction*)));
345 346 347 348 349 350

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

351 352 353 354 355 356
void QGCToolBar::advancedActivityTriggered(QAction* action)
{
    if (action->isChecked())
        advancedButton->setChecked(true);
}

357 358
void QGCToolBar::setActiveUAS(UASInterface* active)
{
359
    // Do nothing if system is the same
360 361
    if (mav == active || active == NULL)
        return;
362

363
    // If switching UASes, disconnect the only one.
364 365 366 367 368 369
    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
370
        disconnect(mav, SIGNAL(textMessageReceived(int,int,int,QString)), this, SLOT(receiveTextMessage(int,int,int,QString)));
dongfang's avatar
dongfang committed
371
        disconnect(mav, SIGNAL(batteryChanged(UASInterface*, double, double, double,int)), this, SLOT(updateBatteryRemaining(UASInterface*, double, double, double, int)));
372
        disconnect(mav, SIGNAL(armingChanged(bool)), this, SLOT(updateArmingState(bool)));
373
        disconnect(mav, SIGNAL(heartbeatTimeout(bool, unsigned int)), this, SLOT(heartbeatTimeout(bool,unsigned int)));
374
        disconnect(active, SIGNAL(globalPositionChanged(UASInterface*,double,double,double,double,quint64)), this, SLOT(globalPositionChanged(UASInterface*,double,double,double,double,quint64)));
375 376
        if (mav->getWaypointManager())
        {
377
            disconnect(mav->getWaypointManager(), SIGNAL(currentWaypointChanged(quint16)), this, SLOT(updateCurrentWaypoint(quint16)));
378 379
            disconnect(mav->getWaypointManager(), SIGNAL(waypointDistanceChanged(double)), this, SLOT(updateWaypointDistance(double)));
        }
380
    }
381 382 383 384 385
    else
    {
        // Only update the UI once a UAS has been selected.
        updateViewTimer.start(2000);
    }
386 387 388

    // Connect new system
    mav = active;
389
    if (mav)
390
    {
391 392 393 394 395
        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)));
396
        connect(mav, SIGNAL(batteryChanged(UASInterface*,double,double,double,int)), this, SLOT(updateBatteryRemaining(UASInterface*,double,double,double,int)));
397 398
        connect(mav, SIGNAL(armingChanged(bool)), this, SLOT(updateArmingState(bool)));
        connect(mav, SIGNAL(heartbeatTimeout(bool, unsigned int)), this, SLOT(heartbeatTimeout(bool,unsigned int)));
399
        connect(mav, SIGNAL(globalPositionChanged(UASInterface*,double,double,double,double,quint64)), this, SLOT(globalPositionChanged(UASInterface*,double,double,double,double,quint64)));
400 401 402 403 404
        if (mav->getWaypointManager())
        {
            connect(mav->getWaypointManager(), SIGNAL(currentWaypointChanged(quint16)), this, SLOT(updateCurrentWaypoint(quint16)));
            connect(mav->getWaypointManager(), SIGNAL(waypointDistanceChanged(double)), this, SLOT(updateWaypointDistance(double)));
        }
405

406 407 408
        // Update all values once
        systemName = mav->getUASName();
        systemArmed = mav->isArmed();
409
        toolBarNameLabel->setText(mav->getUASName().replace("MAV", ""));
410 411
        toolBarNameLabel->setStyleSheet(QString("QLabel {color: %1;}").arg(mav->getColor().name()));
        symbolLabel->setStyleSheet(QString("QWidget {background-color: %1;}").arg(mav->getColor().name()));
412 413 414 415 416
        QString shortMode = mav->getShortMode();
        shortMode = shortMode.replace("D|", "");
        shortMode = shortMode.replace("A|", "");
        toolBarModeLabel->setText(shortMode);
//        toolBarStateLabel->setText(mav->getShortState());
417 418 419
        toolBarTimeoutAction->setVisible(false);
        toolBarMessageLabel->clear();
        lastSystemMessageTimeMs = 0;
420 421 422 423 424
        toolBarBatteryBar->setEnabled(true);
        setSystemType(mav, mav->getSystemType());
    }
    else
    {
425 426 427 428 429
        updateViewTimer.stop();
        resetToolbarUI();
    }
}

430 431 432 433
void QGCToolBar::updateArmingState(bool armed)
{
    systemArmed = armed;
    changed = true;
Lorenz Meier's avatar
Lorenz Meier committed
434 435
    /* important, immediately update */
    updateView();
436 437
}

lm's avatar
lm committed
438 439 440
void QGCToolBar::updateView()
{
    if (!changed) return;
441
    if (toolBarWpAction->isVisible())
442 443
        toolBarWpLabel->setText(tr("WP%1").arg(wpId));

444
    if (toolBarBatteryBarAction->isVisible()) {
445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464
        toolBarBatteryBar->setValue(batteryPercent);

        if (batteryPercent < 30 && toolBarBatteryBar->value() >= 30) {
            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}");
            }
        } else if (batteryPercent >= 30 && toolBarBatteryBar->value() < 30){
            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}");
            }
465
        }
466

467 468 469
    }
    if (toolBarBatteryVoltageLabel->isVisible()) {
	toolBarBatteryVoltageLabel->setText(tr("%1 V").arg(batteryVoltage, 4, 'f', 1, ' '));
Lorenz Meier's avatar
Lorenz Meier committed
470 471
    }

472 473

//    toolBarStateLabel->setText(QString("%1").arg(state));
474 475 476
    if (mode.size() > 0) {
        toolBarModeLabel->setText(QString("%1").arg(mode));
    }
lm's avatar
lm committed
477
    toolBarNameLabel->setText(systemName);
478
    // expire after 15 seconds
479

480
    if (toolBarMessageAction->isVisible()) {
481 482 483 484 485
        if (QGC::groundTimeMilliseconds() - lastSystemMessageTimeMs < 15000) {
            toolBarMessageLabel->setText(QString("%1").arg(lastSystemMessage));
        } else {
            toolBarMessageLabel->clear();
        }
486
    }
487

488
    // Display the system armed state with a red-on-yellow background if armed or green text if safe.
489 490
    if (systemArmed)
    {
491
        toolBarSafetyLabel->setStyleSheet(QString("QLabel {color: %1; background-color: %2; font-size: 15pt;}").arg(QGC::colorRed.name()).arg(QGC::colorYellow.name()));
492 493 494 495
        toolBarSafetyLabel->setText(tr("ARMED"));
    }
    else
    {
496 497
        if (MainWindow::instance()->getStyle() == MainWindow::QGC_MAINWINDOW_STYLE_LIGHT)
        {
498
            toolBarSafetyLabel->setStyleSheet("QLabel {color: #0D820D; font-size: 15pt;}");
499 500 501
        }
        else
        {
502
            toolBarSafetyLabel->setStyleSheet("QLabel {color: #14C814; font-size: 15pt;}");
503
        }
Lorenz Meier's avatar
Lorenz Meier committed
504
        toolBarSafetyLabel->setText(tr("DISARMED"));
505 506
    }

lm's avatar
lm committed
507
    changed = false;
lm's avatar
lm committed
508 509
}

510 511
void QGCToolBar::updateWaypointDistance(double distance)
{
lm's avatar
lm committed
512 513
    if (wpDistance != distance) changed = true;
    wpDistance = distance;
514 515 516 517
}

void QGCToolBar::updateCurrentWaypoint(quint16 id)
{
lm's avatar
lm committed
518
    if (wpId != id) changed = true;
lm's avatar
lm committed
519
    wpId = id;
520 521
}

dongfang's avatar
dongfang committed
522
void QGCToolBar::updateBatteryRemaining(UASInterface* uas, double voltage, double current, double percent, int seconds)
LM's avatar
LM committed
523
{
524 525
    Q_UNUSED(uas);
    Q_UNUSED(seconds);
526
    Q_UNUSED(current);
527

lm's avatar
lm committed
528
    if (batteryPercent != percent || batteryVoltage != voltage) changed = true;
lm's avatar
lm committed
529 530
    batteryPercent = percent;
    batteryVoltage = voltage;
LM's avatar
LM committed
531 532
}

533 534 535 536
void QGCToolBar::updateState(UASInterface* system, QString name, QString description)
{
    Q_UNUSED(system);
    Q_UNUSED(description);
lm's avatar
lm committed
537
    if (state != name) changed = true;
lm's avatar
lm committed
538
    state = name;
Lorenz Meier's avatar
Lorenz Meier committed
539 540
    /* important, immediately update */
    updateView();
541 542 543 544 545 546
}

void QGCToolBar::updateMode(int system, QString name, QString description)
{
    Q_UNUSED(system);
    Q_UNUSED(description);
547 548 549 550 551 552 553 554 555 556
    if (name.size() == 0) {
        qDebug() << "EMPTY MODE, RETURN";
    }

    QString shortMode = name;
    shortMode = shortMode.replace("D|", "");
    shortMode = shortMode.replace("A|", "");

    if (mode != shortMode) changed = true;
    mode = shortMode;
Lorenz Meier's avatar
Lorenz Meier committed
557 558
    /* important, immediately update */
    updateView();
559 560 561 562
}

void QGCToolBar::updateName(const QString& name)
{
Lorenz Meier's avatar
Lorenz Meier committed
563 564 565 566
    if (systemName != name)
    {
        changed = true;
    }
lm's avatar
lm committed
567
    systemName = name;
568 569 570 571 572 573 574 575 576 577 578 579
}

/**
 * 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);
580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640
    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));
641 642
}

LM's avatar
LM committed
643 644 645 646 647
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
648
    if (lastSystemMessage != text) changed = true;
lm's avatar
lm committed
649
    lastSystemMessage = text;
650
    lastSystemMessageTimeMs = QGC::groundTimeMilliseconds();
LM's avatar
LM committed
651 652
}

653 654
void QGCToolBar::addLink(LinkInterface* link)
{
655 656 657 658 659
    // Accept only serial links as current link
    SerialLink* serial = qobject_cast<SerialLink*>(link);

    if (serial && !currentLink)
    {
660 661
        toolBarPortAction->setVisible(true);
        toolBarBaudAction->setVisible(true);
662

663 664 665
        currentLink = link;
        connect(currentLink, SIGNAL(connected(bool)), this, SLOT(updateLinkState(bool)));
        updateLinkState(link->isConnected());
666 667 668 669

        qDebug() << "ADD LINK";

        updateComboBox();
670 671 672 673 674 675 676
    }
}

void QGCToolBar::removeLink(LinkInterface* link)
{
    if (link == currentLink) {
        currentLink = NULL;
677 678 679 680 681 682 683 684 685

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

        // Update GUI according to scan result
        if (currentLink) {
686 687
            updateLinkState(currentLink->isConnected());
        } else {
688 689 690
            connectButton->setText(tr("New Serial Link"));
            portComboBox->hide();
            baudcomboBox->hide();
691 692
        }
    }
693 694 695 696
    updateComboBox();
}
void QGCToolBar::updateComboBox()
{
697
    if (currentLink && !currentLink->isConnected())
698
    {
Lorenz Meier's avatar
Lorenz Meier committed
699 700 701 702
        // Do not update if not visible
        if (!portComboBox->isVisible())
            return;

703 704
        SerialLink *slink = qobject_cast<SerialLink*>(currentLink);
        QList<QString> portlist = slink->getCurrentPorts();
705 706 707 708 709 710
        foreach (QString port, portlist)
        {
            if (portComboBox->findText(port) == -1)
            {
                portComboBox->addItem(port, port);
            }
711 712
        }

713 714
        if (!userPortChoice) {
            if (slink->getPortName().trimmed().length() > 0)
715
            {
716 717 718 719 720
                int portIndex = portComboBox->findData(slink->getPortName());
                if (portIndex >= 0) {
                    portComboBox->setCurrentIndex(portIndex);
                    portComboBox->setEditText(slink->getPortName());
                }
721 722 723
            }
            else
            {
724 725 726 727 728 729 730 731
                if (portlist.length() > 0)
                {
                    portComboBox->setEditText(portlist.last());
                }
                else
                {
                    portComboBox->setEditText(tr("No serial port found"));
                }
732
            }
733
        }
734 735 736

        if (!userBaudChoice) {
            int index = baudcomboBox->findData(slink->getBaudRate());
737
            if (index >= 0)
738 739
                baudcomboBox->setCurrentIndex(index);
        }
740
    }
741 742 743 744
}

void QGCToolBar::updateLinkState(bool connected)
{
745
    Q_UNUSED(connected);
746
    if (currentLink && currentLink->isConnected() && portComboBox->isVisible())
747 748 749 750 751
    {
        connectButton->setText(tr("Disconnect"));
        connectButton->blockSignals(true);
        connectButton->setChecked(true);
        connectButton->blockSignals(false);
752 753 754 755
        toolBarPortAction->setVisible(false);
        toolBarBaudAction->setVisible(false);
        toolBarMessageAction->setVisible(true);
        toolBarWpAction->setVisible(true);
756 757 758 759 760 761 762
    }
    else
    {
        connectButton->setText(tr("Connect"));
        connectButton->blockSignals(true);
        connectButton->setChecked(false);
        connectButton->blockSignals(false);
763 764 765 766
        toolBarPortAction->setVisible(true);
        toolBarBaudAction->setVisible(true);
        toolBarMessageAction->setVisible(false);
        toolBarWpAction->setVisible(false);
767 768 769
    }
}

770 771
void QGCToolBar::connectLink(bool connect)
{
772
    // No serial port yet present
773
    if (connect && LinkManager::instance()->getSerialLinks().count() == 0)
774 775
    {
        MainWindow::instance()->addLink();
776
        currentLink = LinkManager::instance()->getLinks().last();
777
    } else if (connect) {
778 779
        SerialLink *link = qobject_cast<SerialLink*>(currentLink);
        if (link)
780
        {
781
            link->setPortName(portComboBox->itemData(portComboBox->currentIndex()).toString().trimmed());
782 783
            int baud = baudcomboBox->currentText().toInt();
            link->setBaudRate(baud);
784 785
            link->connect();
        }
786 787 788

    } else if (!connect && currentLink) {
        currentLink->disconnect();
789 790 791
    }
}

792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807

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

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

808 809
void QGCToolBar::clearStatusString()
{
Lorenz Meier's avatar
Lorenz Meier committed
810 811 812 813 814
    if (toolBarMessageLabel->text().length() > 0)
    {
        lastSystemMessage = "";
        changed = true;
    }
815 816
}

817 818
QGCToolBar::~QGCToolBar()
{
819
    storeSettings();
820
}