UASView.cc 22.7 KB
Newer Older
pixhawk's avatar
pixhawk committed
1 2 3 4 5 6 7 8 9 10 11
/*=====================================================================
PIXHAWK Micro Air Vehicle Flying Robotics Toolkit

(c) 2009, 2010 PIXHAWK PROJECT  <http://pixhawk.ethz.ch>

This file is part of the PIXHAWK project

    PIXHAWK 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.
12

pixhawk's avatar
pixhawk committed
13 14 15 16
    PIXHAWK 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.
17

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

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

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

#include <cmath>
#include <QDateTime>
#include <QDebug>
34
#include <QMenu>
35
#include <QInputDialog>
pixhawk's avatar
pixhawk committed
36

37
#include "QGC.h"
pixhawk's avatar
pixhawk committed
38 39
#include "UASManager.h"
#include "UASView.h"
40
#include "UASWaypointManager.h"
41
#include "MainWindow.h"
pixhawk's avatar
pixhawk committed
42
#include "ui_UASView.h"
43
#include <QGCHilFlightGearConfiguration.h>
pixhawk's avatar
pixhawk committed
44 45

UASView::UASView(UASInterface* uas, QWidget *parent) :
46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79
    QWidget(parent),
    uas(uas),
    startTime(0),
    timeout(false),
    iconIsRed(true),
    disconnected(false),
    timeRemaining(0),
    chargeLevel(0),
    load(0),
    state("UNKNOWN"),
    stateDesc(tr("Unknown state")),
    mode("MAV_MODE_UNKNOWN"),
    thrust(0),
    isActive(false),
    x(0),
    y(0),
    z(0),
    totalSpeed(0),
    lat(0),
    lon(0),
    alt(0),
    groundDistance(0),
    localFrame(false),
    globalFrameKnown(false),
    removeAction(new QAction(tr("Delete this system"), this)),
    renameAction(new QAction(tr("Rename.."), this)),
    selectAction(new QAction(tr("Control this system"), this)),
    hilAction(new QAction(tr("HIL - Hardware in the Loop"), this)),
    selectAirframeAction(new QAction(tr("Choose Airframe"), this)),
    setBatterySpecsAction(new QAction(tr("Set Battery Options"), this)),
    lowPowerModeEnabled(true),
    generalUpdateCount(0),
    filterTime(0),
    m_ui(new Ui::UASView)
80
{
81 82
    m_ui->setupUi(this);

83 84 85
    // FIXME XXX
    lowPowerModeEnabled = MainWindow::instance()->lowPowerModeEnabled();

lm's avatar
lm committed
86
    hilAction->setCheckable(true);
87

pixhawk's avatar
pixhawk committed
88
    // Setup communication
pixhawk's avatar
pixhawk committed
89
    //connect(uas, SIGNAL(valueChanged(int,QString,double,quint64)), this, SLOT(receiveValue(int,QString,double,quint64)));
dongfang's avatar
dongfang committed
90
    connect(uas, SIGNAL(batteryChanged(UASInterface*, double, double, double, int)), this, SLOT(updateBattery(UASInterface*, double, double, double, int)));
pixhawk's avatar
pixhawk committed
91 92 93 94
    connect(uas, SIGNAL(heartbeat(UASInterface*)), this, SLOT(receiveHeartbeat(UASInterface*)));
    connect(uas, SIGNAL(thrustChanged(UASInterface*, double)), this, SLOT(updateThrust(UASInterface*, double)));
    connect(uas, SIGNAL(localPositionChanged(UASInterface*,double,double,double,quint64)), this, SLOT(updateLocalPosition(UASInterface*,double,double,double,quint64)));
    connect(uas, SIGNAL(globalPositionChanged(UASInterface*,double,double,double,quint64)), this, SLOT(updateGlobalPosition(UASInterface*,double,double,double,quint64)));
95
    connect(uas, SIGNAL(velocityChanged_NED(UASInterface*,double,double,double,quint64)), this, SLOT(updateSpeed(UASInterface*,double,double,double,quint64)));
pixhawk's avatar
pixhawk committed
96
    connect(uas, SIGNAL(statusChanged(UASInterface*,QString,QString)), this, SLOT(updateState(UASInterface*,QString,QString)));
pixhawk's avatar
pixhawk committed
97
    connect(uas, SIGNAL(modeChanged(int,QString,QString)), this, SLOT(updateMode(int,QString,QString)));
pixhawk's avatar
pixhawk committed
98
    connect(uas, SIGNAL(loadChanged(UASInterface*, double)), this, SLOT(updateLoad(UASInterface*, double)));
99
    connect(uas, SIGNAL(heartbeatTimeout(bool, unsigned int)), this, SLOT(heartbeatTimeout(bool, unsigned int)));
pixhawk's avatar
pixhawk committed
100
    connect(uas, SIGNAL(waypointSelected(int,int)), this, SLOT(selectWaypoint(int,int)));
pixhawk's avatar
pixhawk committed
101
    connect(uas->getWaypointManager(), SIGNAL(currentWaypointChanged(quint16)), this, SLOT(currentWaypointUpdated(quint16)));
pixhawk's avatar
pixhawk committed
102
    connect(uas, SIGNAL(systemTypeSet(UASInterface*,uint)), this, SLOT(setSystemType(UASInterface*,uint)));
103
    connect(UASManager::instance(), SIGNAL(activeUASStatusChanged(UASInterface*,bool)), this, SLOT(updateActiveUAS(UASInterface*,bool)));
104 105 106
    connect(uas, SIGNAL(textMessageReceived(int,int,int,QString)), this, SLOT(showStatusText(int, int, int, QString)));
    connect(uas, SIGNAL(navModeChanged(int, int, QString)), this, SLOT(updateNavMode(int, int, QString)));

pixhawk's avatar
pixhawk committed
107
    // Setup UAS selection
108
    connect(this, SIGNAL(clicked(bool)), this, SLOT(setUASasActive(bool)));
109

pixhawk's avatar
pixhawk committed
110 111 112 113
    // Setup user interaction
    connect(m_ui->liftoffButton, SIGNAL(clicked()), uas, SLOT(launch()));
    connect(m_ui->haltButton, SIGNAL(clicked()), uas, SLOT(halt()));
    connect(m_ui->continueButton, SIGNAL(clicked()), uas, SLOT(go()));
114
    connect(m_ui->landButton, SIGNAL(clicked()), uas, SLOT(land()));
pixhawk's avatar
pixhawk committed
115
    connect(m_ui->abortButton, SIGNAL(clicked()), uas, SLOT(emergencySTOP()));
pixhawk's avatar
pixhawk committed
116 117
    connect(m_ui->killButton, SIGNAL(clicked()), uas, SLOT(emergencyKILL()));
    connect(m_ui->shutdownButton, SIGNAL(clicked()), uas, SLOT(shutdown()));
118

119 120
    // Allow deleting this widget
    connect(removeAction, SIGNAL(triggered()), this, SLOT(triggerUASDeletion()));
121
    connect(renameAction, SIGNAL(triggered()), this, SLOT(rename()));
122
    connect(selectAction, SIGNAL(triggered()), uas, SLOT(setSelected()));
123
    connect(hilAction, SIGNAL(triggered(bool)), this, SLOT(showHILUi()));
124
    connect(selectAirframeAction, SIGNAL(triggered()), this, SLOT(selectAirframe()));
125
    connect(setBatterySpecsAction, SIGNAL(triggered()), this, SLOT(setBatterySpecs()));
126 127 128

    // Name changes
    connect(uas, SIGNAL(nameChanged(QString)), this, SLOT(updateName(QString)));
129

pixhawk's avatar
pixhawk committed
130
    // Set static values
131

pixhawk's avatar
pixhawk committed
132
    // Name
133 134
    if (uas->getUASName() == "")
    {
pixhawk's avatar
pixhawk committed
135
        m_ui->nameLabel->setText(tr("UAS") + QString::number(uas->getUASID()));
136 137 138
    }
    else
    {
pixhawk's avatar
pixhawk committed
139 140
        m_ui->nameLabel->setText(uas->getUASName());
    }
141

pixhawk's avatar
pixhawk committed
142 143 144
    // Heartbeat fade
    refreshTimer = new QTimer(this);
    connect(refreshTimer, SIGNAL(timeout()), this, SLOT(refresh()));
145 146
    if (lowPowerModeEnabled)
    {
147
        refreshTimer->start(updateInterval*3);
148 149 150
    }
    else
    {
151 152
        refreshTimer->start(updateInterval);
    }
153

154 155 156 157 158 159 160
    // Style some elements by default to the UAS' color.
    heartbeatColor = uas->getColor();
    QString colorstyle("QLabel { background-color: %1; }");
    m_ui->typeLabel->setStyleSheet(colorstyle.arg(heartbeatColor.name()));
    updateActiveUAS(uas, false);

    // Hide kill and shutdown buttons by default
161 162 163
    m_ui->killButton->hide();
    m_ui->shutdownButton->hide();

164 165 166
    // Set state and mode
    updateMode(uas->getUASID(), uas->getShortMode(), "");
    updateState(uas, uas->getShortState(), "");
167
    setSystemType(uas, uas->getSystemType());
pixhawk's avatar
pixhawk committed
168 169 170 171 172 173 174
}

UASView::~UASView()
{
    delete m_ui;
}

175
void UASView::heartbeatTimeout(bool timeout, unsigned int ms)
176
{
177 178
    Q_UNUSED(ms);
    this->timeout = timeout;
179
}
180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195

void UASView::updateNavMode(int uasid, int mode, const QString& text)
{
    Q_UNUSED(uasid);
    Q_UNUSED(mode);
    m_ui->navLabel->setText(text);
}

void UASView::showStatusText(int uasid, int componentid, int severity, QString text)
{
    Q_UNUSED(uasid);
    Q_UNUSED(componentid);
    Q_UNUSED(severity);
    //m_ui->statusTextLabel->setText(text);
    stateDesc = text;
}
196

197
void UASView::setUASasActive(bool active)
pixhawk's avatar
pixhawk committed
198
{
199 200
    if (active)
    {
201 202 203 204 205 206
        UASManager::instance()->setActiveUAS(this->uas);
    }
}

void UASView::updateActiveUAS(UASInterface* uas, bool active)
{
207 208
    if (uas == this->uas)
    {
209
        this->isActive = active;
210 211 212 213 214 215 216 217
        if (active)
        {
            setStyleSheet("UASView { border-width: 3px}");
        }
        else
        {
            setStyleSheet(QString("UASView { border-color: %1}").arg(heartbeatColor.name()));
        }
218
    }
pixhawk's avatar
pixhawk committed
219 220
}

pixhawk's avatar
pixhawk committed
221 222
void UASView::updateMode(int sysId, QString status, QString description)
{
223
    Q_UNUSED(description);
224 225

    //int aa=this->uas->getUASID();
pixhawk's avatar
pixhawk committed
226
    if (sysId == this->uas->getUASID()) m_ui->modeLabel->setText(status);
227 228

    m_ui->modeLabel->setText(status);
pixhawk's avatar
pixhawk committed
229 230
}

pixhawk's avatar
pixhawk committed
231 232
void UASView::mouseDoubleClickEvent (QMouseEvent * event)
{
233
    Q_UNUSED(event);
pixhawk's avatar
pixhawk committed
234
    UASManager::instance()->setActiveUAS(uas);
235
    // qDebug() << __FILE__ << __LINE__ << "DOUBLECLICKED";
pixhawk's avatar
pixhawk committed
236 237 238 239
}

void UASView::enterEvent(QEvent* event)
{
240 241
    if (event->type() == QEvent::MouseMove)
    {
242
        emit uasInFocus(uas);
243 244
        if (uas != UASManager::instance()->getActiveUAS())
        {
245 246 247
            grabMouse(QCursor(Qt::PointingHandCursor));
        }
    }
248

249 250
    if (event->type() == QEvent::MouseButtonDblClick)
    {
251
        // qDebug() << __FILE__ << __LINE__ << "UAS CLICKED!";
252
    }
pixhawk's avatar
pixhawk committed
253 254 255 256
}

void UASView::leaveEvent(QEvent* event)
{
257 258
    if (event->type() == QEvent::MouseMove)
    {
259 260 261 262 263 264 265 266 267
        emit uasOutFocus(uas);
        releaseMouse();
    }
}

void UASView::showEvent(QShowEvent* event)
{
    // React only to internal (pre-display)
    // events
268
    Q_UNUSED(event);
269
    refreshTimer->start(updateInterval*10);
270 271 272 273 274 275 276
}

void UASView::hideEvent(QHideEvent* event)
{
    // React only to internal (pre-display)
    // events
    Q_UNUSED(event);
277
   // refreshTimer->stop();
pixhawk's avatar
pixhawk committed
278 279 280 281
}

void UASView::receiveHeartbeat(UASInterface* uas)
{
282 283 284 285 286 287 288 289 290 291
    heartbeatColor = uas->getColor();
    QString colorstyle("QLabel { background-color: %1; }");
    m_ui->heartBeatLabel->setStyleSheet(colorstyle.arg(heartbeatColor.name()));

    // If we're returning from a disconnection, recolor things properly.
    if (disconnected)
    {
        updateActiveUAS(this->uas, this->isActive);
        disconnected = false;
    }
292 293 294 295 296
    timeout = false;
}

void UASView::updateName(const QString& name)
{
297
    if (uas) m_ui->nameLabel->setText(name);
pixhawk's avatar
pixhawk committed
298 299 300 301 302 303 304 305 306 307 308
}

/**
 * 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 UASView::setSystemType(UASInterface* uas, unsigned int systemType)
{
309 310
    if (uas == this->uas)
    {
pixhawk's avatar
pixhawk committed
311
        // Set matching icon
312 313
        switch (systemType)
        {
314
        case MAV_TYPE_GENERIC:
315
            m_ui->typeLabel->setPixmap(QPixmap(":/files/images/mavs/generic.svg"));
pixhawk's avatar
pixhawk committed
316
            break;
317
        case MAV_TYPE_FIXED_WING:
318
            m_ui->typeLabel->setPixmap(QPixmap(":/files/images/mavs/fixed-wing.svg"));
pixhawk's avatar
pixhawk committed
319
            break;
320
        case MAV_TYPE_QUADROTOR:
321
            m_ui->typeLabel->setPixmap(QPixmap(":/files/images/mavs/quadrotor.svg"));
pixhawk's avatar
pixhawk committed
322
            break;
323
        case MAV_TYPE_COAXIAL:
324
            m_ui->typeLabel->setPixmap(QPixmap(":/files/images/mavs/coaxial.svg"));
pixhawk's avatar
pixhawk committed
325
            break;
326
        case MAV_TYPE_HELICOPTER:
327
            m_ui->typeLabel->setPixmap(QPixmap(":/files/images/mavs/helicopter.svg"));
pixhawk's avatar
pixhawk committed
328
            break;
329
        case MAV_TYPE_ANTENNA_TRACKER:
330
            m_ui->typeLabel->setPixmap(QPixmap(":/files/images/mavs/unknown.svg"));
lm's avatar
lm committed
331
            break;
332
        case MAV_TYPE_GCS: {
333 334
                // A groundstation is a special system type, update widget
                QString result;
lm's avatar
lm committed
335
                m_ui->nameLabel->setText(tr("GCS ") + result.sprintf("%03d", uas->getUASID()));
336 337 338 339 340 341 342 343 344 345 346 347
                m_ui->waypointLabel->setText("");
                m_ui->timeRemainingLabel->setText("Online:");
                m_ui->batteryBar->hide();
                m_ui->thrustBar->hide();
                m_ui->stateLabel->hide();
                m_ui->statusTextLabel->hide();
                m_ui->waypointLabel->hide();
                m_ui->liftoffButton->hide();
                m_ui->haltButton->hide();
                m_ui->landButton->hide();
                m_ui->shutdownButton->hide();
                m_ui->abortButton->hide();
348
                m_ui->typeLabel->setPixmap(QPixmap(":/files/images/mavs/groundstation.svg"));
349 350
            }
            break;
351
        case MAV_TYPE_AIRSHIP:
352
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/airship.svg"));
353 354
            break;
        case MAV_TYPE_FREE_BALLOON:
355
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/free-balloon.svg"));
356 357
            break;
        case MAV_TYPE_ROCKET:
358
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/rocket.svg"));
359 360
            break;
        case MAV_TYPE_GROUND_ROVER:
361
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/ground-rover.svg"));
362 363
            break;
        case MAV_TYPE_SURFACE_BOAT:
364
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/surface-boat.svg"));
365 366
            break;
        case MAV_TYPE_SUBMARINE:
367
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/submarine.svg"));
368 369
            break;
        case MAV_TYPE_HEXAROTOR:
370
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/hexarotor.svg"));
371 372
            break;
        case MAV_TYPE_OCTOROTOR:
373
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/octorotor.svg"));
374 375
            break;
        case MAV_TYPE_TRICOPTER:
376
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/tricopter.svg"));
377 378
            break;
        case MAV_TYPE_FLAPPING_WING:
379
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/flapping-wing.svg"));
380 381
            break;
        case MAV_TYPE_KITE:
382
            m_ui->typeLabel->setPixmap(QPixmap(":files/images/mavs/kite.svg"));
383
            break;
pixhawk's avatar
pixhawk committed
384
        default:
385
            m_ui->typeLabel->setPixmap(QPixmap(":/files/images/mavs/unknown.svg"));
pixhawk's avatar
pixhawk committed
386 387 388 389 390 391 392
            break;
        }
    }
}

void UASView::updateLocalPosition(UASInterface* uas, double x, double y, double z, quint64 usec)
{
393
    Q_UNUSED(usec);
394 395 396 397
    Q_UNUSED(uas);
    this->x = x;
    this->y = y;
    this->z = z;
398
    localFrame = true;
pixhawk's avatar
pixhawk committed
399 400
}

401
void UASView::updateGlobalPosition(UASInterface* uas, double lon, double lat, double alt, quint64 usec)
pixhawk's avatar
pixhawk committed
402
{
403 404
    Q_UNUSED(uas);
    Q_UNUSED(usec);
pixhawk's avatar
pixhawk committed
405 406 407
    this->lon = lon;
    this->lat = lat;
    this->alt = alt;
408
    globalFrameKnown = true;
pixhawk's avatar
pixhawk committed
409 410 411 412
}

void UASView::updateSpeed(UASInterface*, double x, double y, double z, quint64 usec)
{
413
    Q_UNUSED(usec);
414
    totalSpeed = sqrt(x*x + y*y + z*z);
pixhawk's avatar
pixhawk committed
415 416
}

417 418 419 420 421
void UASView::currentWaypointUpdated(quint16 waypoint)
{
    m_ui->waypointLabel->setText(tr("WP") + QString::number(waypoint));
}

pixhawk's avatar
pixhawk committed
422 423
void UASView::setWaypoint(int uasId, int id, double x, double y, double z, double yaw, bool autocontinue, bool current)
{
424 425 426 427 428
    Q_UNUSED(x);
    Q_UNUSED(y);
    Q_UNUSED(z);
    Q_UNUSED(yaw);
    Q_UNUSED(autocontinue);
429 430 431 432
    if (uasId == this->uas->getUASID())
    {
        if (current)
        {
pixhawk's avatar
pixhawk committed
433 434 435 436 437 438 439
            m_ui->waypointLabel->setText(tr("WP") + QString::number(id));
        }
    }
}

void UASView::selectWaypoint(int uasId, int id)
{
440 441
    if (uasId == this->uas->getUASID())
    {
pixhawk's avatar
pixhawk committed
442 443 444 445 446 447
        m_ui->waypointLabel->setText(tr("WP") + QString::number(id));
    }
}

void UASView::updateThrust(UASInterface* uas, double thrust)
{
448 449
    if (this->uas == uas)
    {
pixhawk's avatar
pixhawk committed
450
        this->thrust = thrust;
pixhawk's avatar
pixhawk committed
451 452 453
    }
}

dongfang's avatar
dongfang committed
454
void UASView::updateBattery(UASInterface* uas, double voltage, double current, double percent, int seconds)
pixhawk's avatar
pixhawk committed
455
{
456
    Q_UNUSED(voltage);
dongfang's avatar
dongfang committed
457
    Q_UNUSED(current);
458 459
    if (this->uas == uas)
    {
pixhawk's avatar
pixhawk committed
460 461 462 463 464 465 466
        timeRemaining = seconds;
        chargeLevel = percent;
    }
}

void UASView::updateState(UASInterface* uas, QString uasState, QString stateDescription)
{
467 468
    if (this->uas == uas)
    {
pixhawk's avatar
pixhawk committed
469 470 471 472 473 474 475
        state = uasState;
        stateDesc = stateDescription;
    }
}

void UASView::updateLoad(UASInterface* uas, double load)
{
476 477
    if (this->uas == uas)
    {
pixhawk's avatar
pixhawk committed
478 479 480 481
        this->load = load;
    }
}

482 483
void UASView::contextMenuEvent (QContextMenuEvent* event)
{
484
    QMenu menu(this);
lm's avatar
lm committed
485 486
    menu.addAction(selectAction);
    menu.addSeparator();
487
    menu.addAction(renameAction);
488 489
    if (timeout)
    {
490
        menu.addAction(removeAction);
491
    }
492
    menu.addAction(hilAction);
493
    menu.addAction(selectAirframeAction);
494
    menu.addAction(setBatterySpecsAction);
495 496 497
    menu.exec(event->globalPos());
}

498 499
void UASView::setBatterySpecs()
{
500 501
    if (uas)
    {
502 503
        bool ok;
        QString newName = QInputDialog::getText(this, tr("Set Battery Specifications for %1").arg(uas->getUASName()),
504
                                                tr("Specs: (empty,warn,full), e.g. (9V,9.5V,12.6V) or just warn level in percent (e.g. 15%) to use estimate from MAV"), QLineEdit::Normal,
505 506 507 508 509 510
                                                uas->getBatterySpecs(), &ok);

        if (ok && !newName.isEmpty()) uas->setBatterySpecs(newName);
    }
}

511 512
void UASView::rename()
{
513 514
    if (uas)
    {
515 516 517 518 519 520
        bool ok;
        QString newName = QInputDialog::getText(this, tr("Rename System %1").arg(uas->getUASName()),
                                                tr("System Name:"), QLineEdit::Normal,
                                                uas->getUASName(), &ok);

        if (ok && !newName.isEmpty()) uas->setUASName(newName);
521 522 523
    }
}

524 525
void UASView::selectAirframe()
{
526 527
    if (uas)
    {
528 529 530
        // Get list of airframes from UAS
        QStringList airframes;
        airframes << "Generic"
531 532 533 534 535 536 537 538
                << "Multiplex Easystar"
                << "Multiplex Twinstar"
                << "Multiplex Merlin"
                << "Pixhawk Cheetah"
                << "Mikrokopter"
                << "Reaper"
                << "Predator"
                << "Coaxial"
539
                << "Pteryx"
Lorenz Meier's avatar
Lorenz Meier committed
540 541 542 543 544
                << "Tricopter"
                << "Asctec Firefly"
                << "X8 Flying Wing"
                << "Viper 2.0 Flying Wing"
                << "Cam Flyer Q Flying Wing";
545 546 547 548

        bool ok;
        QString item = QInputDialog::getItem(this, tr("Select Airframe for %1").arg(uas->getUASName()),
                                             tr("Airframe"), airframes, uas->getAirframe(), false, &ok);
549 550
        if (ok && !item.isEmpty())
        {
551 552 553 554 555 556
            // Set this airframe as UAS airframe
            uas->setAirframe(airframes.indexOf(item));
        }
    }
}

557 558 559 560 561
void UASView::showHILUi()
{
     MainWindow::instance()->showHILConfigurationWidget(uas);
}

562
void UASView::triggerUASDeletion()
563 564 565 566 567
{
    refreshTimer->stop();
    UASManager::instance()->removeUAS(uas);
}

pixhawk's avatar
pixhawk committed
568 569
void UASView::refresh()
{
570 571
    if (generalUpdateCount == 4)
    {
572
#if (QGC_EVENTLOOP_DEBUG)
573
        // qDebug() << "EVENTLOOP:" << __FILE__ << __LINE__;
574
#endif
575
        generalUpdateCount = 0;
576
        //// qDebug() << "UPDATING EVERYTHING";
577 578 579 580 581 582 583 584 585 586
        // State
        m_ui->stateLabel->setText(state);
        m_ui->statusTextLabel->setText(stateDesc);

        // Battery
        m_ui->batteryBar->setValue(static_cast<int>(this->chargeLevel));
        //m_ui->loadBar->setValue(static_cast<int>(this->load));
        m_ui->thrustBar->setValue(this->thrust);

        // Position
587 588 589 590 591 592 593
        // If global position is known, prefer it over local coordinates

        if (!globalFrameKnown && localFrame)
        {
            QString position;
            position = position.sprintf("%05.1f %05.1f %06.1f m", x, y, z);
            m_ui->positionLabel->setText(position);
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

        if (globalFrameKnown)
        {
            QString globalPosition;
            QString latIndicator;
            if (lat > 0)
            {
                latIndicator = "N";
            }
            else
            {
                latIndicator = "S";
            }
            QString lonIndicator;
            if (lon > 0)
            {
                lonIndicator = "E";
            }
            else
            {
                lonIndicator = "W";
            }

            globalPosition = globalPosition.sprintf("%05.1f%s %05.1f%s %06.1f m", lon, lonIndicator.toStdString().c_str(), lat, latIndicator.toStdString().c_str(), alt);
            m_ui->positionLabel->setText(globalPosition);
620
        }
pixhawk's avatar
pixhawk committed
621

622
        // Altitude
623 624
        if (groundDistance == 0 && alt != 0)
        {
625
            m_ui->groundDistanceLabel->setText(QString("%1 m").arg(alt, 6, 'f', 1, '0'));
626 627 628
        }
        else
        {
629
            m_ui->groundDistanceLabel->setText(QString("%1 m").arg(groundDistance, 6, 'f', 1, '0'));
630
        }
631

632
        // Speed
633 634
        QString speed("%1 m/s");
        m_ui->speedLabel->setText(speed.arg(totalSpeed, 4, 'f', 1, '0'));
pixhawk's avatar
pixhawk committed
635

636 637
        // Thrust
        m_ui->thrustBar->setValue(thrust * 100);
pixhawk's avatar
pixhawk committed
638

639 640
        if(this->timeRemaining > 1 && this->timeRemaining < QGC::MAX_FLIGHT_TIME)
        {
641
            // Filter output to get a higher stability
642
            filterTime = static_cast<int>(this->timeRemaining);
643 644 645 646 647 648 649 650
            filterTime = 0.8 * filterTime + 0.2 * static_cast<int>(this->timeRemaining);
            int sec = static_cast<int>(filterTime - static_cast<int>(filterTime / 60.0f) * 60);
            int min = static_cast<int>(filterTime / 60);
            int hours = static_cast<int>(filterTime - min * 60 - sec);

            QString timeText;
            timeText = timeText.sprintf("%02d:%02d:%02d", hours, min, sec);
            m_ui->timeRemainingLabel->setText(timeText);
651 652 653
        }
        else
        {
654
            m_ui->timeRemainingLabel->setText(tr("Calc.."));
655 656 657 658 659 660 661
        }

        // Time Elapsed
        //QDateTime time = MG::TIME::msecToQDateTime(uas->getUptime());

        quint64 filterTime = uas->getUptime() / 1000;
        int sec = static_cast<int>(filterTime - static_cast<int>(filterTime / 60) * 60);
pixhawk's avatar
pixhawk committed
662 663 664 665
        int min = static_cast<int>(filterTime / 60);
        int hours = static_cast<int>(filterTime - min * 60 - sec);
        QString timeText;
        timeText = timeText.sprintf("%02d:%02d:%02d", hours, min, sec);
666
        m_ui->timeElapsedLabel->setText(timeText);
pixhawk's avatar
pixhawk committed
667
    }
668
    generalUpdateCount++;
pixhawk's avatar
pixhawk committed
669

670 671
    if (timeout)
    {
672
        // CRITICAL CONDITION, NO HEARTBEAT
673
        disconnected = true;
674

675
        QColor warnColor;
676 677
        if (iconIsRed)
        {
678
            warnColor = Qt::red;
679 680 681
        }
        else
        {
682
            warnColor = Qt::darkRed;
LM's avatar
LM committed
683
            refreshTimer->setInterval(errorUpdateInterval);
684
            refreshTimer->start();
685
        }
686 687
        QString style = QString("UASView {background-color: %1;}").arg(warnColor.name());
        this->setStyleSheet(style);
688
        iconIsRed = !iconIsRed;
689 690 691
    }
    else
    {
692 693
        // If we're not in low power mode, add the additional visual effect of
        // fading out the color of the heartbeat for this UAS.
694 695
        if (!lowPowerModeEnabled)
        {
696 697 698
            heartbeatColor = heartbeatColor.darker(110);
            QString colorstyle("QLabel {background-color: %1;}");
            m_ui->heartBeatLabel->setStyleSheet(colorstyle.arg(heartbeatColor.name()));
LM's avatar
LM committed
699
            refreshTimer->setInterval(updateInterval);
700
            refreshTimer->start();
701
        }
702
    }
pixhawk's avatar
pixhawk committed
703 704 705 706 707
}

void UASView::changeEvent(QEvent *e)
{
    QWidget::changeEvent(e);
708 709
    switch (e->type())
    {
pixhawk's avatar
pixhawk committed
710 711 712 713 714 715 716
    case QEvent::LanguageChange:
        m_ui->retranslateUi(this);
        break;
    default:
        break;
    }
}
717 718 719 720 721

/**
 * Implement paintEvent() so that stylesheets work for our custom widget.
 */
void UASView::paintEvent(QPaintEvent *)
722 723 724 725 726 727
{
    QStyleOption opt;
    opt.init(this);
    QPainter p(this);
    style()->drawPrimitive(QStyle::PE_Widget, &opt, &p, this);
}