WaypointList.cc 22.5 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
 *
 */

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

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

pixhawk's avatar
pixhawk committed
57
58
    m_ui->setupUi(this);

pixhawk's avatar
pixhawk committed
59
60
61
62
63
64
65
    //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
66
67
68
69

    // 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()));
70
    connect(m_ui->actionAddWaypoint, SIGNAL(triggered()), this, SLOT(addEditable()));
pixhawk's avatar
pixhawk committed
71

72
    // ADD WAYPOINT AT CURRENT POSITION
73
    connect(m_ui->positionAddButton, SIGNAL(clicked()), this, SLOT(addCurrentPositionWaypoint()));
74

pixhawk's avatar
pixhawk committed
75
76
77
    // SEND WAYPOINTS
    connect(m_ui->transmitButton, SIGNAL(clicked()), this, SLOT(transmit()));

78
79
80
    // DELETE ALL WAYPOINTS
    connect(m_ui->clearWPListButton, SIGNAL(clicked()), this, SLOT(clearWPWidget()));

81
    // REQUEST WAYPOINTS
82
    connect(m_ui->readButton, SIGNAL(clicked()), this, SLOT(read()));
83

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

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

pixhawk's avatar
pixhawk committed
90
91
92
93
94
95
96
97
98
99
    //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

100
    connect(m_ui->refreshButton, SIGNAL(clicked()), this, SLOT(refresh()));
101

102
103
104
105
    if (WPM) {
        // SET UAS AFTER ALL SIGNALS/SLOTS ARE CONNECTED
        if (!WPM->getUAS())
        {
106
107
108
109
110
111
            // Disable buttons which don't make sense without valid UAS.
            m_ui->positionAddButton->setEnabled(false);
            m_ui->transmitButton->setEnabled(false);
            m_ui->readButton->setEnabled(false);
            m_ui->refreshButton->setEnabled(false);

112
            //FIXME: The whole "Onboard Waypoints"-tab should be hidden, instead of "refresh" button
113
114
115
116
117
118
119
120
            // Insert a "NO UAV" info into the Onboard Tab
            QLabel* noUas = new QLabel(this);
            noUas->setObjectName("noUas");
            noUas->setText("NO UAS");
            noUas->setEnabled(false);
            noUas->setAlignment(Qt::AlignCenter);
            viewOnlyListLayout->insertWidget(0, noUas);

121
122
123
124
            showOfflineWarning = true;
        } else {
            setUAS(static_cast<UASInterface*>(WPM->getUAS()));
        }
125

126
127
128
129
130
131
132
        /* connect slots */
        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)));
133
134
135
136
137

        //Even if there are no waypoints, since this is a new instance and there is an
        //existing WPM, then we need to assume things have changed, and act appropriatly.
        waypointEditableListChanged();
        waypointViewOnlyListChanged();
138
    }
139
140
141

    // STATUS LABEL
    updateStatusLabel("");
142
143

    this->setVisible(false);
144
    loadFileGlobalWP = false;
tecnosapiens's avatar
tecnosapiens committed
145
    readGlobalWP = false;
146
147
148
    centerMapCoordinate.setX(0.0);
    centerMapCoordinate.setY(0.0);

pixhawk's avatar
pixhawk committed
149
150
151
152
153
154
155
}

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

156
void WaypointList::updatePosition(UASInterface* uas, double x, double y, double z, quint64 usec)
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
{
    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
174
175
void WaypointList::setUAS(UASInterface* uas)
{
176
177
178
179
    if (!uas)
        return;

    if (this->uas != NULL)
lm's avatar
lm committed
180
    {
181
182
183
184
185
186
187
188
189
190
191
        // Clear current list
        on_clearWPListButton_clicked();
        // Disconnect everything
        disconnect(WPM, SIGNAL(updateStatusString(const QString &)),        this, SLOT(updateStatusLabel(const QString &)));
        disconnect(WPM, SIGNAL(waypointEditableListChanged(void)),                  this, SLOT(waypointEditableListChanged(void)));
        disconnect(WPM, SIGNAL(waypointEditableChanged(int,Waypoint*)), this, SLOT(updateWaypointEditable(int,Waypoint*)));
        disconnect(WPM, SIGNAL(waypointViewOnlyListChanged(void)),                  this, SLOT(waypointViewOnlyListChanged(void)));
        disconnect(WPM, SIGNAL(waypointViewOnlyChanged(int,Waypoint*)), this, SLOT(updateWaypointViewOnly(int,Waypoint*)));
        disconnect(WPM, SIGNAL(currentWaypointChanged(quint16)),            this, SLOT(currentWaypointViewOnlyChanged(quint16)));
        disconnect(this->uas, SIGNAL(localPositionChanged(UASInterface*,double,double,double,quint64)),  this, SLOT(updatePosition(UASInterface*,double,double,double,quint64)));
        disconnect(this->uas, SIGNAL(attitudeChanged(UASInterface*,double,double,double,quint64)),       this, SLOT(updateAttitude(UASInterface*,double,double,double,quint64)));
pixhawk's avatar
pixhawk committed
192
    }
193

194
195
196
197
198
199
    // Now that there's a valid UAS, enable the UI.
    m_ui->positionAddButton->setEnabled(true);
    m_ui->transmitButton->setEnabled(true);
    m_ui->readButton->setEnabled(true);
    m_ui->refreshButton->setEnabled(true);

200
201
202
203
204
205
206
207
208
209
210
211
212
213
    WPM = uas->getWaypointManager();

    this->uas = uas;
    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)));
    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)));
    //connect(WPM,SIGNAL(loadWPFile()),this,SLOT(setIsLoadFileWP()));
    //connect(WPM,SIGNAL(readGlobalWPFromUAS(bool)),this,SLOT(setIsReadGlobalWP(bool)));

214
215
    // Update list
    read();
pixhawk's avatar
pixhawk committed
216
217
}

pixhawk's avatar
pixhawk committed
218
219
void WaypointList::saveWaypoints()
{
220

221
222
    QString fileName = QFileDialog::getSaveFileName(this, tr("Save File"), "./waypoints.txt", tr("Waypoint File (*.txt)"));
    WPM->saveWaypoints(fileName);
223

pixhawk's avatar
pixhawk committed
224
225
226
227
}

void WaypointList::loadWaypoints()
{
228
229
    QString fileName = QFileDialog::getOpenFileName(this, tr("Load File"), ".", tr("Waypoint File (*.txt)"));
    WPM->loadWaypoints(fileName);
pixhawk's avatar
pixhawk committed
230
231
232
233
}

void WaypointList::transmit()
{
lm's avatar
lm committed
234
235
    if (uas)
    {
236
        WPM->writeWaypoints();
pixhawk's avatar
pixhawk committed
237
238
239
240
241
    }
}

void WaypointList::read()
{
lm's avatar
lm committed
242
243
    if (uas)
    {
244
        WPM->readWaypoints(true);
pixhawk's avatar
pixhawk committed
245
246
247
248
249
250
251
    }
}

void WaypointList::refresh()
{
    if (uas)
    {
252
        WPM->readWaypoints(false);
pixhawk's avatar
pixhawk committed
253
254
255
    }
}

pixhawk's avatar
pixhawk committed
256
void WaypointList::addEditable()
pixhawk's avatar
pixhawk committed
257
{
258
259
    addEditable(false);
}
pixhawk's avatar
pixhawk committed
260

261
262
263
void WaypointList::addEditable(bool onCurrentPosition)
{

264
    const QList<Waypoint *> &waypoints = WPM->getWaypointEditableList();
265
    Waypoint *wp;
266
    if (waypoints.count() > 0 &&
267
268
269
            !(onCurrentPosition && uas && (uas->localPositionKnown() || uas->globalPositionKnown())))
    {
        // Create waypoint with last frame
270
        Waypoint *last = waypoints.last();
271
        wp = WPM->createWaypoint();
272
//        wp->blockSignals(true);
273
274
275
        MAV_FRAME frame = (MAV_FRAME)last->getFrame();
        wp->setFrame(frame);
        if (frame == MAV_FRAME_GLOBAL || frame == MAV_FRAME_GLOBAL_RELATIVE_ALT)
276
        {
277
278
279
280
281
282
283
            wp->setLatitude(last->getLatitude());
            wp->setLongitude(last->getLongitude());
            wp->setAltitude(last->getAltitude());
        } else {
            wp->setX(last->getX());
            wp->setY(last->getY());
            wp->setZ(last->getZ());
284
        }
285
286
287
288
289
        wp->setParam1(last->getParam1());
        wp->setParam1(last->getParam2());
        wp->setParam1(last->getParam3());
        wp->setParam1(last->getParam4());
        wp->setAutocontinue(last->getAutoContinue());
290
//        wp->blockSignals(false);
291
292
293
294
295
296
297
298
299
        wp->setAction(last->getAction());
//        WPM->addWaypointEditable(wp);
    }
    else
    {
        if (uas)
        {
            // Create first waypoint at current MAV position
            if (uas->globalPositionKnown())
300
            {
301
                if (onCurrentPosition)
302
                {
303
304
305
306
307
308

                    if (WPM->getFrameRecommendation() == MAV_FRAME_GLOBAL) {
                        updateStatusLabel(tr("Added default GLOBAL (Abs alt.) waypoint."));
                    } else {
                        updateStatusLabel(tr("Added default GLOBAL (Relative alt.) waypoint."));
                    }
309
                    wp = new Waypoint(0, uas->getLatitude(), uas->getLongitude(), uas->getAltitudeAMSL(), 0, WPM->getAcceptanceRadiusRecommendation(), 0, 0,true, true, (MAV_FRAME)WPM->getFrameRecommendation(), MAV_CMD_NAV_WAYPOINT);
310
311
312
313
314
315
316
317
318
319
320
321
322
                    WPM->addWaypointEditable(wp);

                } else {

                    if (WPM->getFrameRecommendation() == MAV_FRAME_GLOBAL) {
                        updateStatusLabel(tr("Added default GLOBAL (Abs alt.) waypoint."));
                    } else {
                        updateStatusLabel(tr("Added default GLOBAL (Relative alt.) waypoint."));
                    }
                    wp = new Waypoint(0, UASManager::instance()->getHomeLatitude(),
                                      UASManager::instance()->getHomeLongitude(),
                                      WPM->getAltitudeRecommendation(), 0, WPM->getAcceptanceRadiusRecommendation(), 0, 0,true, true, (MAV_FRAME)WPM->getFrameRecommendation(), MAV_CMD_NAV_WAYPOINT);
                    WPM->addWaypointEditable(wp);
323
                }
324
325
326
327
            }
            else if (uas->localPositionKnown())
            {
                if (onCurrentPosition)
328
                {
329
330
331
332
333
334
335
                    updateStatusLabel(tr("Added default LOCAL (NED) waypoint."));
                    wp = new Waypoint(0, uas->getLocalX(), uas->getLocalY(), uas->getLocalZ(), 0, WPM->getAcceptanceRadiusRecommendation(), 0, 0,true, true, MAV_FRAME_LOCAL_NED, MAV_CMD_NAV_WAYPOINT);
                    WPM->addWaypointEditable(wp);
                } else {
                    updateStatusLabel(tr("Added default LOCAL (NED) waypoint."));
                    wp = new Waypoint(0, 0, 0, -0.50, 0, WPM->getAcceptanceRadiusRecommendation(), 0, 0,true, true, MAV_FRAME_LOCAL_NED, MAV_CMD_NAV_WAYPOINT);
                    WPM->addWaypointEditable(wp);
336
                }
337
338
339
            }
            else
            {
340
341
342
343
344
                // MAV connected, but position unknown, add default waypoint
                updateStatusLabel(tr("WARNING: No position known. Adding default LOCAL (NED) waypoint"));
                wp = new Waypoint(0, UASManager::instance()->getHomeLatitude(),
                                  UASManager::instance()->getHomeLongitude(),
                                  WPM->getAltitudeRecommendation(), 0, WPM->getAcceptanceRadiusRecommendation(), 0, 0,true, true, (MAV_FRAME)WPM->getFrameRecommendation(), MAV_CMD_NAV_WAYPOINT);
345
346
                WPM->addWaypointEditable(wp);
            }
347
        }
348
        else
349
        {
350
351
352
353
354
            //Since no UAV available, create first default waypoint.
            updateStatusLabel(tr("No UAV connected. Adding default GLOBAL (NED) waypoint"));
            wp = new Waypoint(0, UASManager::instance()->getHomeLatitude(),
                              UASManager::instance()->getHomeLongitude(),
                              WPM->getAltitudeRecommendation(), 0, WPM->getAcceptanceRadiusRecommendation(), 0, 0,true, true, (MAV_FRAME)WPM->getFrameRecommendation(), MAV_CMD_NAV_WAYPOINT);
355
            WPM->addWaypointEditable(wp);
pixhawk's avatar
pixhawk committed
356
        }
pixhawk's avatar
pixhawk committed
357
358
359
    }
}

360
361
362
363
void WaypointList::addCurrentPositionWaypoint() {
    addEditable(true);
}

pixhawk's avatar
pixhawk committed
364
365
void WaypointList::updateStatusLabel(const QString &string)
{
366
    // Status label in write widget
pixhawk's avatar
pixhawk committed
367
    m_ui->statusLabel->setText(string);
368
369
    // Status label in read only widget
    m_ui->viewStatusLabel->setText(string);
pixhawk's avatar
pixhawk committed
370
371
}

372
// Request UASWaypointManager to send the SET_CURRENT message to UAV
373
void WaypointList::changeCurrentWaypoint(quint16 seq)
pixhawk's avatar
pixhawk committed
374
{
375
376
    if (uas)
    {
377
        WPM->setCurrentWaypoint(seq);
378
    }
pixhawk's avatar
pixhawk committed
379
380
}

381
// Request UASWaypointManager to set the new "current" and make sure all other waypoints are not "current"
382
void WaypointList::currentWaypointEditableChanged(quint16 seq)
383
{
384
        WPM->setCurrentEditable(seq);
385
        const QList<Waypoint *> &waypoints = WPM->getWaypointEditableList();
386

387
        if (seq < waypoints.count())
388
        {
389
            for(int i = 0; i < waypoints.count(); i++)
390
            {
pixhawk's avatar
pixhawk committed
391
                WaypointEditableView* widget = wpEditableViews.find(waypoints[i]).value();
392

393
394
                if (waypoints[i]->getId() == seq)
                {
395
                    widget->setCurrent(true);
396
397
398
                }
                else
                {
399
400
401
402
403
404
                    widget->setCurrent(false);
                }
            }
        }
}

405
// Update waypointViews to correctly indicate the new current waypoint
406
407
void WaypointList::currentWaypointViewOnlyChanged(quint16 seq)
{
408
409
410
    // First update the edit list
    currentWaypointEditableChanged(seq);

411
    const QList<Waypoint *> &waypoints = WPM->getWaypointViewOnlyList();
412

413
    if (seq < waypoints.count())
414
    {
415
        for(int i = 0; i < waypoints.count(); i++)
416
        {
417
            WaypointViewOnlyView* widget = wpViewOnlyViews.find(waypoints[i]).value();
418

419
420
421
422
423
424
425
            if (waypoints[i]->getId() == seq)
            {
                widget->setCurrent(true);
            }
            else
            {
                widget->setCurrent(false);
426
427
428
            }
        }
    }
429
    m_ui->tabWidget->setCurrentIndex(1); // XXX magic number
430
431
432
}

void WaypointList::updateWaypointEditable(int uas, Waypoint* wp)
433
434
{
    Q_UNUSED(uas);
pixhawk's avatar
pixhawk committed
435
    WaypointEditableView *wpv = wpEditableViews.value(wp);
436
    wpv->updateValues();
437
    m_ui->tabWidget->setCurrentIndex(0); // XXX magic number
438
439
}

440
441
442
443
444
void WaypointList::updateWaypointViewOnly(int uas, Waypoint* wp)
{
    Q_UNUSED(uas);
    WaypointViewOnlyView *wpv = wpViewOnlyViews.value(wp);
    wpv->updateValues();
445
    m_ui->tabWidget->setCurrentIndex(1); // XXX magic number
446
447
}

pixhawk's avatar
pixhawk committed
448
449
void WaypointList::waypointViewOnlyListChanged()
{
450
451
    // Prevent updates to prevent visual flicker
    this->setUpdatesEnabled(false);
452
    const QList<Waypoint *> &waypoints = WPM->getWaypointViewOnlyList();
453
454
455
456
457
458
459
460

    if (!wpViewOnlyViews.empty()) {
        QMapIterator<Waypoint*,WaypointViewOnlyView*> viewIt(wpViewOnlyViews);
        viewIt.toFront();
        while(viewIt.hasNext()) {
            viewIt.next();
            Waypoint *cur = viewIt.key();
            int i;
461
            for (i = 0; i < waypoints.count(); i++) {
462
463
                if (waypoints[i] == cur) {
                    break;
pixhawk's avatar
pixhawk committed
464
465
                }
            }
466
            if (i == waypoints.count()) {
467
468
469
470
                WaypointViewOnlyView* widget = wpViewOnlyViews.find(cur).value();
                widget->hide();
                viewOnlyListLayout->removeWidget(widget);
                wpViewOnlyViews.remove(cur);
pixhawk's avatar
pixhawk committed
471
            }
472
473
        }
    }
pixhawk's avatar
pixhawk committed
474

475
    // then add/update the views for each waypoint in the list
476
    for(int i = 0; i < waypoints.count(); i++) {
477
478
479
480
481
482
483
484
        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
485

486
487
488
489
        //check if ordering has changed
        if(viewOnlyListLayout->itemAt(i)->widget() != wpv) {
            viewOnlyListLayout->removeWidget(wpv);
            viewOnlyListLayout->insertWidget(i, wpv);
pixhawk's avatar
pixhawk committed
490
        }
491
492

        wpv->updateValues();    // update the values of the ui elements in the view
pixhawk's avatar
pixhawk committed
493
    }
494
495
496
    this->setUpdatesEnabled(true);
    loadFileGlobalWP = false;

497
498
    m_ui->tabWidget->setCurrentIndex(1);

pixhawk's avatar
pixhawk committed
499
500
501
}


502
void WaypointList::waypointEditableListChanged()
pixhawk's avatar
pixhawk committed
503
{
504
505
    // Prevent updates to prevent visual flicker
    this->setUpdatesEnabled(false);
506
    const QList<Waypoint *> &waypoints = WPM->getWaypointEditableList();
507
508
509
510
511
512
513
514

    if (!wpEditableViews.empty()) {
        QMapIterator<Waypoint*,WaypointEditableView*> viewIt(wpEditableViews);
        viewIt.toFront();
        while(viewIt.hasNext()) {
            viewIt.next();
            Waypoint *cur = viewIt.key();
            int i;
515
            for (i = 0; i < waypoints.count(); i++) {
516
517
                if (waypoints[i] == cur) {
                    break;
lm's avatar
lm committed
518
                }
pixhawk's avatar
pixhawk committed
519
            }
520
            if (i == waypoints.count()) {
521
522
523
524
                WaypointEditableView* widget = wpEditableViews.find(cur).value();
                widget->hide();
                editableListLayout->removeWidget(widget);
                wpEditableViews.remove(cur);
525
            }
526
527
        }
    }
528

529
    // then add/update the views for each waypoint in the list
530
    for(int i = 0; i < waypoints.count(); i++) {
531
532
533
534
535
536
537
538
539
540
541
542
        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
543

544
545
546
547
        //check if ordering has changed
        if(editableListLayout->itemAt(i)->widget() != wpv) {
            editableListLayout->removeWidget(wpv);
            editableListLayout->insertWidget(i, wpv);
548
        }
lm's avatar
lm committed
549

550
551
552
553
        wpv->updateValues();    // update the values of the ui elements in the view
    }
    this->setUpdatesEnabled(true);
    loadFileGlobalWP = false;
554

555
}
pixhawk's avatar
pixhawk committed
556

557
void WaypointList::moveUp(Waypoint* wp)
pixhawk's avatar
pixhawk committed
558
{
559
    const QList<Waypoint *> &waypoints = WPM->getWaypointEditableList();
560

561
562
    //get the current position of wp in the local storage
    int i;
563
    for (i = 0; i < waypoints.count(); i++) {
564
565
566
        if (waypoints[i] == wp)
            break;
    }
567

568
    // if wp was found and its not the first entry, move it
569
    if (i < waypoints.count() && i > 0) {
570
        WPM->moveWaypoint(i, i-1);
pixhawk's avatar
pixhawk committed
571
572
573
    }
}

574
void WaypointList::moveDown(Waypoint* wp)
575
{    
576
    const QList<Waypoint *> &waypoints = WPM->getWaypointEditableList();
577
578
579

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

585
    // if wp was found and its not the last entry, move it
586
    if (i < waypoints.count()-1) {
587
        WPM->moveWaypoint(i, i+1);
pixhawk's avatar
pixhawk committed
588
589
590
591
    }
}

void WaypointList::removeWaypoint(Waypoint* wp)
592
593
{    
        WPM->removeWaypoint(wp->getId());
pixhawk's avatar
pixhawk committed
594
595
596
597
598
599
600
601
602
603
604
605
606
}

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

607
608
609
610


void WaypointList::on_clearWPListButton_clicked()
{
611
612
    if (uas) {
        emit clearPathclicked();
613
614
        const QList<Waypoint *> &waypoints = WPM->getWaypointEditableList();
        while(!waypoints.isEmpty()) {
pixhawk's avatar
pixhawk committed
615
            WaypointEditableView* widget = wpEditableViews.find(waypoints[0]).value();
616
            widget->remove();
617
        }
lm's avatar
lm committed
618
    }
619
620
}

621
void WaypointList::clearWPWidget()
622
{    
623
        // Get list
624
        const QList<Waypoint *> &waypoints = WPM->getWaypointEditableList();
625
626
627
628
629


        // XXX delete wps as well

        // Clear UI elements
630
        while(!waypoints.isEmpty()) {
pixhawk's avatar
pixhawk committed
631
            WaypointEditableView* widget = wpEditableViews.find(waypoints[0]).value();
632
            widget->remove();
633
        }
634
}