WaypointList.cc 20.8 KB
Newer Older
pixhawk's avatar
pixhawk committed
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 26 27 28 29
/*=====================================================================

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.

    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.

    You should have received a copy of the GNU General Public License
    along with PIXHAWK. If not, see <http://www.gnu.org/licenses/>.

======================================================================*/

/**
 * @file
 *   @brief Waypoint list widget
 *
 *   @author Lorenz Meier <mavteam@student.ethz.ch>
 *   @author Benjamin Knecht <mavteam@student.ethz.ch>
30
 *   @author Petri Tanskanen <mavteam@student.ethz.ch>
pixhawk's avatar
pixhawk committed
31 32 33 34 35 36 37 38 39
 *
 */

#include "WaypointList.h"
#include "ui_WaypointList.h"
#include <UASInterface.h>
#include <UASManager.h>
#include <QDebug>
#include <QFileDialog>
40
#include <QMessageBox>
41
#include <QMouseEvent>
pixhawk's avatar
pixhawk committed
42 43

WaypointList::WaypointList(QWidget *parent, UASInterface* uas) :
44 45 46 47 48 49
    QWidget(parent),
    uas(NULL),
    mavX(0.0),
    mavY(0.0),
    mavZ(0.0),
    mavYaw(0.0),
50
    showOfflineWarning(false),
51
    m_ui(new Ui::WaypointList)
pixhawk's avatar
pixhawk committed
52
{
53

pixhawk's avatar
pixhawk committed
54 55
    m_ui->setupUi(this);

pixhawk's avatar
pixhawk committed
56 57 58 59 60 61 62
    //EDIT TAB

    editableListLayout = new QVBoxLayout(m_ui->editableListWidget);
    editableListLayout->setSpacing(0);
    editableListLayout->setMargin(0);
    editableListLayout->setAlignment(Qt::AlignTop);
    m_ui->editableListWidget->setLayout(editableListLayout);
pixhawk's avatar
pixhawk committed
63 64 65 66

    // ADD WAYPOINT
    // Connect add action, set right button icon and connect action to this class
    connect(m_ui->addButton, SIGNAL(clicked()), m_ui->actionAddWaypoint, SIGNAL(triggered()));
67
    connect(m_ui->actionAddWaypoint, SIGNAL(triggered()), this, SLOT(addEditable()));
pixhawk's avatar
pixhawk committed
68

69
    // ADD WAYPOINT AT CURRENT POSITION
70
    connect(m_ui->positionAddButton, SIGNAL(clicked()), this, SLOT(addCurrentPositionWaypoint()));
71

pixhawk's avatar
pixhawk committed
72 73 74
    // SEND WAYPOINTS
    connect(m_ui->transmitButton, SIGNAL(clicked()), this, SLOT(transmit()));

75 76 77
    // DELETE ALL WAYPOINTS
    connect(m_ui->clearWPListButton, SIGNAL(clicked()), this, SLOT(clearWPWidget()));

78
    // REQUEST WAYPOINTS
79
    connect(m_ui->readButton, SIGNAL(clicked()), this, SLOT(read()));
80

pixhawk's avatar
pixhawk committed
81 82 83 84
    // SAVE/LOAD WAYPOINTS
    connect(m_ui->saveButton, SIGNAL(clicked()), this, SLOT(saveWaypoints()));
    connect(m_ui->loadButton, SIGNAL(clicked()), this, SLOT(loadWaypoints()));

85
    //connect(UASManager::instance(), SIGNAL(activeUASSet(UASInterface*)), this, SLOT(setUAS(UASInterface*)));
pixhawk's avatar
pixhawk committed
86

pixhawk's avatar
pixhawk committed
87 88 89 90 91 92 93 94 95 96
    //VIEW TAB

    viewOnlyListLayout = new QVBoxLayout(m_ui->viewOnlyListWidget);
    viewOnlyListLayout->setSpacing(0);
    viewOnlyListLayout->setMargin(0);
    viewOnlyListLayout->setAlignment(Qt::AlignTop);
    m_ui->viewOnlyListWidget->setLayout(viewOnlyListLayout);

    // REFRESH VIEW TAB

97
    connect(m_ui->refreshButton, SIGNAL(clicked()), this, SLOT(refresh()));
98 99


pixhawk's avatar
pixhawk committed
100
    // SET UAS AFTER ALL SIGNALS/SLOTS ARE CONNECTED
101 102
    if (uas)
    {
103
        WPM = uas->getWaypointManager();
104
        //setUAS(uas);
105 106 107 108 109 110 111 112
    }
    else
    {
        // Hide buttons, which don't make sense without valid UAS
        m_ui->positionAddButton->hide();
        m_ui->transmitButton->hide();
        m_ui->readButton->hide();
        m_ui->refreshButton->hide();
113
        //FIXME: The whole "Onboard Waypoints"-tab should be hidden, instead of "refresh" button       
114
        UnconnectedUASInfoWidget* inf = new UnconnectedUASInfoWidget(this);
115 116
        viewOnlyListLayout->insertWidget(0, inf); //insert a "NO UAV" info into the Onboard Tab
        showOfflineWarning = true;
117
        WPM = new UASWaypointManager(NULL);
118
    }
119

pixhawk's avatar
pixhawk committed
120
    setUAS(uas);
121 122 123

    // STATUS LABEL
    updateStatusLabel("");
124 125

    this->setVisible(false);
126
    loadFileGlobalWP = false;
127
    readGlobalWP = false;
128 129 130
    centerMapCoordinate.setX(0.0);
    centerMapCoordinate.setY(0.0);

pixhawk's avatar
pixhawk committed
131 132 133 134 135 136 137
}

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

138
void WaypointList::updatePosition(UASInterface* uas, double x, double y, double z, quint64 usec)
139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155
{
    Q_UNUSED(uas);
    Q_UNUSED(usec);
    mavX = x;
    mavY = y;
    mavZ = z;
}

void WaypointList::updateAttitude(UASInterface* uas, double roll, double pitch, double yaw, quint64 usec)
{
    Q_UNUSED(uas);
    Q_UNUSED(usec);
    Q_UNUSED(roll);
    Q_UNUSED(pitch);
    mavYaw = yaw;
}

pixhawk's avatar
pixhawk committed
156 157
void WaypointList::setUAS(UASInterface* uas)
{
LM's avatar
LM committed
158 159 160 161
    if (this->uas == NULL && uas != NULL)
    {
        WPM = uas->getWaypointManager();
    }
162
    if (this->uas == NULL)
lm's avatar
lm committed
163
    {
pixhawk's avatar
pixhawk committed
164
        this->uas = uas;
165 166 167 168 169 170
        connect(WPM, SIGNAL(updateStatusString(const QString &)),        this, SLOT(updateStatusLabel(const QString &)));
        connect(WPM, SIGNAL(waypointEditableListChanged(void)),                  this, SLOT(waypointEditableListChanged(void)));
        connect(WPM, SIGNAL(waypointEditableChanged(int,Waypoint*)), this, SLOT(updateWaypointEditable(int,Waypoint*)));
        connect(WPM, SIGNAL(waypointViewOnlyListChanged(void)),                  this, SLOT(waypointViewOnlyListChanged(void)));
        connect(WPM, SIGNAL(waypointViewOnlyChanged(int,Waypoint*)), this, SLOT(updateWaypointViewOnly(int,Waypoint*)));
        connect(WPM, SIGNAL(currentWaypointChanged(quint16)),            this, SLOT(currentWaypointViewOnlyChanged(quint16)));
171 172 173 174 175
        if (uas != NULL)
        {
            connect(uas, SIGNAL(localPositionChanged(UASInterface*,double,double,double,quint64)),  this, SLOT(updatePosition(UASInterface*,double,double,double,quint64)));
            connect(uas, SIGNAL(attitudeChanged(UASInterface*,double,double,double,quint64)),       this, SLOT(updateAttitude(UASInterface*,double,double,double,quint64)));
        }
176 177
        //connect(WPM,SIGNAL(loadWPFile()),this,SLOT(setIsLoadFileWP()));
        //connect(WPM,SIGNAL(readGlobalWPFromUAS(bool)),this,SLOT(setIsReadGlobalWP(bool)));
pixhawk's avatar
pixhawk committed
178 179 180
    }
}

pixhawk's avatar
pixhawk committed
181 182
void WaypointList::saveWaypoints()
{
183

pixhawk's avatar
pixhawk committed
184
        QString fileName = QFileDialog::getSaveFileName(this, tr("Save File"), "./waypoints.txt", tr("Waypoint File (*.txt)"));
185 186
        WPM->saveWaypoints(fileName);

pixhawk's avatar
pixhawk committed
187 188 189 190
}

void WaypointList::loadWaypoints()
{
191 192 193 194 195 196 197 198 199
    //create a popup notifying the user about the limitations of offline editing
    if (showOfflineWarning == true)
    {
        QMessageBox msgBox;
        msgBox.setIcon(QMessageBox::Warning);
        msgBox.setText("Offline editor!");
        msgBox.setInformativeText("You are using the offline mission editor. Please don't forget to save your mission plan before connecting the UAV, otherwise it will be lost.");
        msgBox.setStandardButtons(QMessageBox::Ok);
        msgBox.setDefaultButton(QMessageBox::Ok);
200
        msgBox.exec();
201 202 203 204
        showOfflineWarning = false;
    }
    QString fileName = QFileDialog::getOpenFileName(this, tr("Load File"), ".", tr("Waypoint File (*.txt)"));
    WPM->loadWaypoints(fileName);
pixhawk's avatar
pixhawk committed
205 206 207 208
}

void WaypointList::transmit()
{
lm's avatar
lm committed
209 210
    if (uas)
    {
211
        WPM->writeWaypoints();
pixhawk's avatar
pixhawk committed
212 213 214 215 216
    }
}

void WaypointList::read()
{
lm's avatar
lm committed
217 218
    if (uas)
    {
219
        WPM->readWaypoints(true);
pixhawk's avatar
pixhawk committed
220 221 222 223 224 225 226
    }
}

void WaypointList::refresh()
{
    if (uas)
    {
227
        WPM->readWaypoints(false);
pixhawk's avatar
pixhawk committed
228 229 230
    }
}

pixhawk's avatar
pixhawk committed
231
void WaypointList::addEditable()
pixhawk's avatar
pixhawk committed
232
{
pixhawk's avatar
pixhawk committed
233

234
        const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();
pixhawk's avatar
pixhawk committed
235
        Waypoint *wp;
236 237
        if (waypoints.size() > 0)
        {
pixhawk's avatar
pixhawk committed
238 239
            // Create waypoint with last frame
            Waypoint *last = waypoints.at(waypoints.size()-1);
lm's avatar
lm committed
240 241
            wp = new Waypoint(0, last->getX(), last->getY(), last->getZ(), last->getParam1(), last->getParam2(), last->getParam3(), last->getParam4(),
                              last->getAutoContinue(), false, last->getFrame(), last->getAction());
242
            WPM->addWaypointEditable(wp);
243 244
        }
        else
245 246 247 248
        {            
            if (uas)
            {
                // Create first waypoint at current MAV position
249 250 251 252 253 254 255 256 257 258 259
                if (uas->localPositionKnown() || uas->globalPositionKnown())
                {
                    addCurrentPositionWaypoint();
                }
                else
                {
                    // MAV connected, but position unknown, add default waypoint
                   updateStatusLabel(tr("WARNING: No position known. Adding default LOCAL (NED) waypoint"));
                   wp = new Waypoint(0, 0, 0, -0.50, 0, 0.20, 0, 0,true, true, MAV_FRAME_LOCAL_NED, MAV_CMD_NAV_WAYPOINT);
                   WPM->addWaypointEditable(wp);
                }
260 261 262 263
            }
            else
            {
                //Since no UAV available, create first default waypoint.
264
                 updateStatusLabel(tr("No UAV connected. Adding default LOCAL (NED) waypoint"));
265 266
                wp = new Waypoint(0, 0, 0, -0.50, 0, 0.20, 0, 0,true, true, MAV_FRAME_LOCAL_NED, MAV_CMD_NAV_WAYPOINT);
                WPM->addWaypointEditable(wp);
267
                //create a popup notifying the user about the limitations of offline editing
268 269 270 271 272 273 274 275
                if (showOfflineWarning == true)
                {
                    QMessageBox msgBox;
                    msgBox.setIcon(QMessageBox::Warning);
                    msgBox.setText("Offline editor!");
                    msgBox.setInformativeText("You are using the offline mission editor. Please don't forget to save your mission plan before connecting the UAV, otherwise it will be lost.");
                    msgBox.setStandardButtons(QMessageBox::Ok);
                    msgBox.setDefaultButton(QMessageBox::Ok);
276
                    msgBox.exec();
277 278
                    showOfflineWarning = false;
                }
279
            }
280
        }
281

pixhawk's avatar
pixhawk committed
282
}
283

pixhawk's avatar
pixhawk committed
284

285
void WaypointList::addCurrentPositionWaypoint()
286
{    
pixhawk's avatar
pixhawk committed
287
    if (uas)
pixhawk's avatar
pixhawk committed
288
    {
289
        const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();
290 291 292
        Waypoint *wp;
        Waypoint *last = 0;
        if (waypoints.size() > 0)
pixhawk's avatar
pixhawk committed
293
        {
294 295 296 297 298 299 300 301 302
            last = waypoints.at(waypoints.size()-1);
        }

        if (uas->globalPositionKnown())
        {
            float acceptanceRadiusGlobal = 10.0f;
            float holdTime = 0.0f;
            float yawGlobal = 0.0f;
            if (last)
303
            {
304 305 306
                acceptanceRadiusGlobal = last->getAcceptanceRadius();
                holdTime = last->getHoldTime();
                yawGlobal = last->getYaw();
307
            }
308
            // Create global frame waypoint per default
309
            wp = new Waypoint(0, uas->getLatitude(), uas->getLongitude(), uas->getAltitude(), 0, acceptanceRadiusGlobal, holdTime, yawGlobal, true, false, MAV_FRAME_GLOBAL_RELATIVE_ALT, MAV_CMD_NAV_WAYPOINT);
310
            WPM->addWaypointEditable(wp);
lm's avatar
lm committed
311
            updateStatusLabel(tr("Added GLOBAL, ALTITUDE OVER GROUND waypoint"));
312 313 314 315 316 317
        }
        else if (uas->localPositionKnown())
        {
            float acceptanceRadiusLocal = 0.2f;
            float holdTime = 0.5f;
            if (last)
318
            {
319 320
                acceptanceRadiusLocal = last->getAcceptanceRadius();
                holdTime = last->getHoldTime();
321
            }
322
            // Create local frame waypoint as second option
323
            wp = new Waypoint(0, uas->getLocalX(), uas->getLocalY(), uas->getLocalZ(), uas->getYaw(), acceptanceRadiusLocal, holdTime, 0.0, true, false, MAV_FRAME_LOCAL_NED, MAV_CMD_NAV_WAYPOINT);
324
            WPM->addWaypointEditable(wp);
lm's avatar
lm committed
325
            updateStatusLabel(tr("Added LOCAL (NED) waypoint"));
326 327 328 329
        }
        else
        {
            // Do nothing
330
            updateStatusLabel(tr("Not adding waypoint, no position of MAV known yet."));
pixhawk's avatar
pixhawk committed
331
        }
pixhawk's avatar
pixhawk committed
332 333 334
    }
}

pixhawk's avatar
pixhawk committed
335 336
void WaypointList::updateStatusLabel(const QString &string)
{
337
    // Status label in write widget
pixhawk's avatar
pixhawk committed
338
    m_ui->statusLabel->setText(string);
339 340
    // Status label in read only widget
    m_ui->viewStatusLabel->setText(string);
pixhawk's avatar
pixhawk committed
341 342
}

343
// Request UASWaypointManager to send the SET_CURRENT message to UAV
344
void WaypointList::changeCurrentWaypoint(quint16 seq)
pixhawk's avatar
pixhawk committed
345
{
346 347
    if (uas)
    {
348
        WPM->setCurrentWaypoint(seq);
349
    }
pixhawk's avatar
pixhawk committed
350 351
}

352
// Request UASWaypointManager to set the new "current" and make sure all other waypoints are not "current"
353
void WaypointList::currentWaypointEditableChanged(quint16 seq)
354
{
355 356
        WPM->setCurrentEditable(seq);
        const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();
357

358 359 360 361
        if (seq < waypoints.size())
        {
            for(int i = 0; i < waypoints.size(); i++)
            {
pixhawk's avatar
pixhawk committed
362
                WaypointEditableView* widget = wpEditableViews.find(waypoints[i]).value();
363

364 365
                if (waypoints[i]->getId() == seq)
                {
366
                    widget->setCurrent(true);
367 368 369
                }
                else
                {
370 371 372 373 374 375
                    widget->setCurrent(false);
                }
            }
        }
}

376
// Update waypointViews to correctly indicate the new current waypoint
377 378
void WaypointList::currentWaypointViewOnlyChanged(quint16 seq)
{
379
    const QVector<Waypoint *> &waypoints = WPM->getWaypointViewOnlyList();
380

381 382 383
    if (seq < waypoints.size())
    {
        for(int i = 0; i < waypoints.size(); i++)
384
        {
385
            WaypointViewOnlyView* widget = wpViewOnlyViews.find(waypoints[i]).value();
386

387 388 389 390 391 392 393
            if (waypoints[i]->getId() == seq)
            {
                widget->setCurrent(true);
            }
            else
            {
                widget->setCurrent(false);
394 395 396 397 398 399
            }
        }
    }
}

void WaypointList::updateWaypointEditable(int uas, Waypoint* wp)
400 401
{
    Q_UNUSED(uas);
pixhawk's avatar
pixhawk committed
402
    WaypointEditableView *wpv = wpEditableViews.value(wp);
403 404 405
    wpv->updateValues();
}

406 407 408 409 410 411 412
void WaypointList::updateWaypointViewOnly(int uas, Waypoint* wp)
{
    Q_UNUSED(uas);
    WaypointViewOnlyView *wpv = wpViewOnlyViews.value(wp);
    wpv->updateValues();
}

pixhawk's avatar
pixhawk committed
413 414
void WaypointList::waypointViewOnlyListChanged()
{
415 416 417 418 419 420 421 422 423 424 425 426 427 428
    // Prevent updates to prevent visual flicker
    this->setUpdatesEnabled(false);
    const QVector<Waypoint *> &waypoints = WPM->getWaypointViewOnlyList();

    if (!wpViewOnlyViews.empty()) {
        QMapIterator<Waypoint*,WaypointViewOnlyView*> viewIt(wpViewOnlyViews);
        viewIt.toFront();
        while(viewIt.hasNext()) {
            viewIt.next();
            Waypoint *cur = viewIt.key();
            int i;
            for (i = 0; i < waypoints.size(); i++) {
                if (waypoints[i] == cur) {
                    break;
pixhawk's avatar
pixhawk committed
429 430
                }
            }
431 432 433 434 435
            if (i == waypoints.size()) {
                WaypointViewOnlyView* widget = wpViewOnlyViews.find(cur).value();
                widget->hide();
                viewOnlyListLayout->removeWidget(widget);
                wpViewOnlyViews.remove(cur);
pixhawk's avatar
pixhawk committed
436
            }
437 438
        }
    }
pixhawk's avatar
pixhawk committed
439

440 441 442 443 444 445 446 447 448 449
    // then add/update the views for each waypoint in the list
    for(int i = 0; i < waypoints.size(); i++) {
        Waypoint *wp = waypoints[i];
        if (!wpViewOnlyViews.contains(wp)) {
            WaypointViewOnlyView* wpview = new WaypointViewOnlyView(wp, this);
            wpViewOnlyViews.insert(wp, wpview);
            connect(wpview, SIGNAL(changeCurrentWaypoint(quint16)), this, SLOT(changeCurrentWaypoint(quint16)));
            viewOnlyListLayout->insertWidget(i, wpview);
        }
        WaypointViewOnlyView *wpv = wpViewOnlyViews.value(wp);
pixhawk's avatar
pixhawk committed
450

451 452 453 454
        //check if ordering has changed
        if(viewOnlyListLayout->itemAt(i)->widget() != wpv) {
            viewOnlyListLayout->removeWidget(wpv);
            viewOnlyListLayout->insertWidget(i, wpv);
pixhawk's avatar
pixhawk committed
455
        }
456 457

        wpv->updateValues();    // update the values of the ui elements in the view
pixhawk's avatar
pixhawk committed
458
    }
459 460 461
    this->setUpdatesEnabled(true);
    loadFileGlobalWP = false;

pixhawk's avatar
pixhawk committed
462 463 464
}


465
void WaypointList::waypointEditableListChanged()
pixhawk's avatar
pixhawk committed
466
{
467 468 469 470 471 472 473 474 475 476 477 478 479 480
    // Prevent updates to prevent visual flicker
    this->setUpdatesEnabled(false);
    const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();

    if (!wpEditableViews.empty()) {
        QMapIterator<Waypoint*,WaypointEditableView*> viewIt(wpEditableViews);
        viewIt.toFront();
        while(viewIt.hasNext()) {
            viewIt.next();
            Waypoint *cur = viewIt.key();
            int i;
            for (i = 0; i < waypoints.size(); i++) {
                if (waypoints[i] == cur) {
                    break;
lm's avatar
lm committed
481
                }
pixhawk's avatar
pixhawk committed
482
            }
483 484 485 486 487
            if (i == waypoints.size()) {
                WaypointEditableView* widget = wpEditableViews.find(cur).value();
                widget->hide();
                editableListLayout->removeWidget(widget);
                wpEditableViews.remove(cur);
488
            }
489 490
        }
    }
491

492 493 494 495 496 497 498 499 500 501 502 503 504 505
    // then add/update the views for each waypoint in the list
    for(int i = 0; i < waypoints.size(); i++) {
        Waypoint *wp = waypoints[i];
        if (!wpEditableViews.contains(wp)) {
            WaypointEditableView* wpview = new WaypointEditableView(wp, this);
            wpEditableViews.insert(wp, wpview);
            connect(wpview, SIGNAL(moveDownWaypoint(Waypoint*)),    this, SLOT(moveDown(Waypoint*)));
            connect(wpview, SIGNAL(moveUpWaypoint(Waypoint*)),      this, SLOT(moveUp(Waypoint*)));
            connect(wpview, SIGNAL(removeWaypoint(Waypoint*)),      this, SLOT(removeWaypoint(Waypoint*)));
            //connect(wpview, SIGNAL(currentWaypointChanged(quint16)), this, SLOT(currentWaypointChanged(quint16)));
            connect(wpview, SIGNAL(changeCurrentWaypoint(quint16)), this, SLOT(currentWaypointEditableChanged(quint16)));
            editableListLayout->insertWidget(i, wpview);
        }
        WaypointEditableView *wpv = wpEditableViews.value(wp);
lm's avatar
lm committed
506

507 508 509 510
        //check if ordering has changed
        if(editableListLayout->itemAt(i)->widget() != wpv) {
            editableListLayout->removeWidget(wpv);
            editableListLayout->insertWidget(i, wpv);
511
        }
lm's avatar
lm committed
512

513 514 515 516
        wpv->updateValues();    // update the values of the ui elements in the view
    }
    this->setUpdatesEnabled(true);
    loadFileGlobalWP = false;
517

pixhawk's avatar
pixhawk committed
518

519
}
pixhawk's avatar
pixhawk committed
520

521
void WaypointList::moveUp(Waypoint* wp)
pixhawk's avatar
pixhawk committed
522
{
523
    const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();
524

525 526 527 528 529 530
    //get the current position of wp in the local storage
    int i;
    for (i = 0; i < waypoints.size(); i++) {
        if (waypoints[i] == wp)
            break;
    }
531

532 533 534
    // if wp was found and its not the first entry, move it
    if (i < waypoints.size() && i > 0) {
        WPM->moveWaypoint(i, i-1);
pixhawk's avatar
pixhawk committed
535 536 537
    }
}

538
void WaypointList::moveDown(Waypoint* wp)
539 540 541 542 543 544 545 546 547
{    
    const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();

    //get the current position of wp in the local storage
    int i;
    for (i = 0; i < waypoints.size(); i++) {
        if (waypoints[i] == wp)
            break;
    }
pixhawk's avatar
pixhawk committed
548

549 550 551
    // if wp was found and its not the last entry, move it
    if (i < waypoints.size()-1) {
        WPM->moveWaypoint(i, i+1);
pixhawk's avatar
pixhawk committed
552 553 554 555
    }
}

void WaypointList::removeWaypoint(Waypoint* wp)
556 557
{    
        WPM->removeWaypoint(wp->getId());
pixhawk's avatar
pixhawk committed
558 559 560 561 562 563 564 565 566 567 568 569 570
}

void WaypointList::changeEvent(QEvent *e)
{
    switch (e->type()) {
    case QEvent::LanguageChange:
        m_ui->retranslateUi(this);
        break;
    default:
        break;
    }
}

571 572 573 574


void WaypointList::on_clearWPListButton_clicked()
{
575

tecnosapiens's avatar
tecnosapiens committed
576

577 578
    if (uas) {
        emit clearPathclicked();
579
        const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();
580
        while(!waypoints.isEmpty()) { //for(int i = 0; i <= waypoints.size(); i++)
pixhawk's avatar
pixhawk committed
581
            WaypointEditableView* widget = wpEditableViews.find(waypoints[0]).value();
582
            widget->remove();
583
        }
584
    } else {
lm's avatar
lm committed
585 586 587 588 589
//        if(isGlobalWP)
//        {
//           emit clearPathclicked();
//        }
    }
590 591
}

pixhawk's avatar
pixhawk committed
592
///** @brief The MapWidget informs that a waypoint global was changed on the map */
593

pixhawk's avatar
pixhawk committed
594 595 596 597
//void WaypointList::waypointGlobalChanged(QPointF coordinate, int indexWP)
//{
//    if (uas)
//    {
598
//        const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();
pixhawk's avatar
pixhawk committed
599 600 601
//        if (waypoints.size() > 0)
//        {
//            Waypoint *temp = waypoints.at(indexWP);
602

pixhawk's avatar
pixhawk committed
603 604
//            temp->setX(coordinate.x());
//            temp->setY(coordinate.y());
605

pixhawk's avatar
pixhawk committed
606 607 608 609
//            //WaypointGlobalView* widget = wpGlobalViews.find(waypoints[indexWP]).value();
//            //widget->updateValues();
//        }
//    }
610 611


pixhawk's avatar
pixhawk committed
612
//}
613

614 615 616 617 618 619 620 621 622 623 624 625 626
///** @brief The MapWidget informs that a waypoint global was changed on the map */

//void WaypointList::waypointGlobalPositionChanged(Waypoint* wp)
//{
//    QPointF coordinate;
//    coordinate.setX(wp->getX());
//    coordinate.setY(wp->getY());

//   emit ChangeWaypointGlobalPosition(wp->getId(), coordinate);


//}

627
void WaypointList::clearWPWidget()
628 629
{    
        const QVector<Waypoint *> &waypoints = WPM->getWaypointEditableList();
630
        while(!waypoints.isEmpty()) { //for(int i = 0; i <= waypoints.size(); i++)
pixhawk's avatar
pixhawk committed
631
            WaypointEditableView* widget = wpEditableViews.find(waypoints[0]).value();
632
            widget->remove();
633
        }    
634
}
635

pixhawk's avatar
pixhawk committed
636 637 638 639
//void WaypointList::setIsLoadFileWP()
//{
//    loadFileGlobalWP = true;
//}
640

pixhawk's avatar
pixhawk committed
641 642 643 644 645 646
//void WaypointList::setIsReadGlobalWP(bool value)
//{
//    // FIXME James Check this
//    Q_UNUSED(value);
//    // readGlobalWP = value;
//}