Skip to content
WaypointList.cc 23.9 KiB
Newer Older
pixhawk's avatar
pixhawk committed
/*=====================================================================

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>
 *   @author Petri Tanskanen <mavteam@student.ethz.ch>
pixhawk's avatar
pixhawk committed
 *
 */

#include "WaypointList.h"
#include "ui_WaypointList.h"
#include <UASInterface.h>
#include <UASManager.h>
#include <QDebug>
#include <QFileDialog>
pixhawk's avatar
pixhawk committed

WaypointList::WaypointList(QWidget *parent, UASInterface* uas) :
    QWidget(parent),
    uas(NULL),
    mavX(0.0),
    mavY(0.0),
    mavZ(0.0),
    mavYaw(0.0),
    m_ui(new Ui::WaypointList)
pixhawk's avatar
pixhawk committed
{
    m_ui->setupUi(this);

pixhawk's avatar
pixhawk committed
    //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

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

    // ADD WAYPOINT AT CURRENT POSITION
    connect(m_ui->positionAddButton, SIGNAL(clicked()), this, SLOT(addCurrentPositionWaypoint()));
pixhawk's avatar
pixhawk committed
    // SEND WAYPOINTS
    connect(m_ui->transmitButton, SIGNAL(clicked()), this, SLOT(transmit()));

    // REQUEST WAYPOINTS
    connect(m_ui->readButton, SIGNAL(clicked()), this, SLOT(read()));
pixhawk's avatar
pixhawk committed
    // SAVE/LOAD WAYPOINTS
    connect(m_ui->saveButton, SIGNAL(clicked()), this, SLOT(saveWaypoints()));
    connect(m_ui->loadButton, SIGNAL(clicked()), this, SLOT(loadWaypoints()));

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

pixhawk's avatar
pixhawk committed
    //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

     connect(m_ui->refreshButton, SIGNAL(clicked()), this, SLOT(refresh()));
pixhawk's avatar
pixhawk committed
    // SET UAS AFTER ALL SIGNALS/SLOTS ARE CONNECTED
    setUAS(uas);

    // STATUS LABEL
    updateStatusLabel("");
    loadFileGlobalWP = false;
    readGlobalWP = false;
    centerMapCoordinate.setX(0.0);
    centerMapCoordinate.setY(0.0);

pixhawk's avatar
pixhawk committed
}

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

void WaypointList::updatePosition(UASInterface* uas, double x, double y, double z, quint64 usec)
{
    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
void WaypointList::setUAS(UASInterface* uas)
{
lm's avatar
lm committed
    if (this->uas == NULL && uas != NULL)
    {
pixhawk's avatar
pixhawk committed
        this->uas = uas;
pixhawk's avatar
pixhawk committed

        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)));
pixhawk's avatar
pixhawk committed

pixhawk's avatar
pixhawk committed
        connect(uas->getWaypointManager(), SIGNAL(updateStatusString(const QString &)),        this, SLOT(updateStatusLabel(const QString &)));
        connect(uas->getWaypointManager(), SIGNAL(waypointEditableListChanged(void)),                  this, SLOT(waypointEditableListChanged(void)));
        connect(uas->getWaypointManager(), SIGNAL(waypointEditableChanged(int,Waypoint*)), this, SLOT(updateWaypointEditable(int,Waypoint*)));
pixhawk's avatar
pixhawk committed
        connect(uas->getWaypointManager(), SIGNAL(waypointViewOnlyListChanged(void)),                  this, SLOT(waypointViewOnlyListChanged(void)));
        connect(uas->getWaypointManager(), SIGNAL(waypointViewOnlyChanged(int,Waypoint*)), this, SLOT(updateWaypointViewOnly(int,Waypoint*)));
        connect(uas->getWaypointManager(), SIGNAL(currentWaypointChanged(quint16)),            this, SLOT(currentWaypointViewOnlyChanged(quint16)));
        //connect(uas->getWaypointManager(),SIGNAL(loadWPFile()),this,SLOT(setIsLoadFileWP()));
        //connect(uas->getWaypointManager(),SIGNAL(readGlobalWPFromUAS(bool)),this,SLOT(setIsReadGlobalWP(bool)));
pixhawk's avatar
pixhawk committed
    }
}

pixhawk's avatar
pixhawk committed
void WaypointList::saveWaypoints()
{
lm's avatar
lm committed
    if (uas)
    {
pixhawk's avatar
pixhawk committed
        QString fileName = QFileDialog::getSaveFileName(this, tr("Save File"), "./waypoints.txt", tr("Waypoint File (*.txt)"));
pixhawk's avatar
pixhawk committed
        uas->getWaypointManager()->saveWaypoints(fileName);
pixhawk's avatar
pixhawk committed
    }
}

void WaypointList::loadWaypoints()
{
lm's avatar
lm committed
    if (uas)
    {
pixhawk's avatar
pixhawk committed
        QString fileName = QFileDialog::getOpenFileName(this, tr("Load File"), ".", tr("Waypoint File (*.txt)"));
pixhawk's avatar
pixhawk committed
        uas->getWaypointManager()->loadWaypoints(fileName);
pixhawk's avatar
pixhawk committed
}

void WaypointList::transmit()
{
lm's avatar
lm committed
    if (uas)
    {
pixhawk's avatar
pixhawk committed
        uas->getWaypointManager()->writeWaypoints();
pixhawk's avatar
pixhawk committed
    }
}

void WaypointList::read()
{
lm's avatar
lm committed
    if (uas)
    {
pixhawk's avatar
pixhawk committed
        uas->getWaypointManager()->readWaypoints(true);
    }
}

void WaypointList::refresh()
{
    if (uas)
    {
        uas->getWaypointManager()->readWaypoints(false);
pixhawk's avatar
pixhawk committed
void WaypointList::addEditable()
pixhawk's avatar
pixhawk committed
{
pixhawk's avatar
pixhawk committed
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
        Waypoint *wp;
        if (waypoints.size() > 0)
        {
            // Create waypoint with last frame
            Waypoint *last = waypoints.at(waypoints.size()-1);
            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());
            uas->getWaypointManager()->addWaypointEditable(wp);
        }
        else
        {
            // Create first waypoint at current MAV position
            addCurrentPositionWaypoint();
        }
    }
}

pixhawk's avatar
pixhawk committed
void WaypointList::addViewOnly()
{
    if (uas)
    {
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointViewOnlyList();
pixhawk's avatar
pixhawk committed
        Waypoint *wp;
        if (waypoints.size() > 0)
        {
pixhawk's avatar
pixhawk committed
            // Create waypoint with last frame
            Waypoint *last = waypoints.at(waypoints.size()-1);
lm's avatar
lm committed
            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());
            uas->getWaypointManager()->addWaypointEditable(wp);
        }
        else
        {
            // Create first waypoint at current MAV position
            addCurrentPositionWaypoint();
pixhawk's avatar
pixhawk committed
    }
}
pixhawk's avatar
pixhawk committed

void WaypointList::addCurrentPositionWaypoint()
lm's avatar
lm committed
{
pixhawk's avatar
pixhawk committed
    if (uas)
pixhawk's avatar
pixhawk committed
    {
pixhawk's avatar
pixhawk committed
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
        Waypoint *wp;
        Waypoint *last = 0;
        if (waypoints.size() > 0)
pixhawk's avatar
pixhawk committed
        {
            last = waypoints.at(waypoints.size()-1);
        }

        if (uas->globalPositionKnown())
        {
            float acceptanceRadiusGlobal = 10.0f;
            float holdTime = 0.0f;
            float yawGlobal = 0.0f;
            if (last)
                acceptanceRadiusGlobal = last->getAcceptanceRadius();
                holdTime = last->getHoldTime();
                yawGlobal = last->getYaw();
            // Create global frame waypoint per default
            wp = new Waypoint(0, uas->getLatitude(), uas->getLongitude(), uas->getAltitude(), 0, acceptanceRadiusGlobal, holdTime, yawGlobal, true, true, MAV_FRAME_GLOBAL_RELATIVE_ALT, MAV_CMD_NAV_WAYPOINT);
            uas->getWaypointManager()->addWaypointEditable(wp);
lm's avatar
lm committed
            updateStatusLabel(tr("Added GLOBAL, ALTITUDE OVER GROUND waypoint"));
        }
        else if (uas->localPositionKnown())
        {
            float acceptanceRadiusLocal = 0.2f;
            float holdTime = 0.5f;
            if (last)
                acceptanceRadiusLocal = last->getAcceptanceRadius();
                holdTime = last->getHoldTime();
            // Create local frame waypoint as second option
lm's avatar
lm committed
            wp = new Waypoint(0, uas->getLocalX(), uas->getLocalY(), uas->getLocalZ(), uas->getYaw(), acceptanceRadiusLocal, holdTime, 0.0, true, true, MAV_FRAME_LOCAL_NED, MAV_CMD_NAV_WAYPOINT);
            uas->getWaypointManager()->addWaypointEditable(wp);
lm's avatar
lm committed
            updateStatusLabel(tr("Added LOCAL (NED) waypoint"));
        }
        else
        {
            // Do nothing
            updateStatusLabel(tr("Not adding waypoint, no position known of MAV known yet."));
pixhawk's avatar
pixhawk committed
        }
pixhawk's avatar
pixhawk committed
    }
}

pixhawk's avatar
pixhawk committed
void WaypointList::updateStatusLabel(const QString &string)
{
    m_ui->statusLabel->setText(string);
}

void WaypointList::changeCurrentWaypoint(quint16 seq)
pixhawk's avatar
pixhawk committed
{
pixhawk's avatar
pixhawk committed
        uas->getWaypointManager()->setCurrentWaypoint(seq);
pixhawk's avatar
pixhawk committed
}


void WaypointList::currentWaypointEditableChanged(quint16 seq)
pixhawk's avatar
pixhawk committed
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
        if (seq < waypoints.size())
        {
            for(int i = 0; i < waypoints.size(); i++)
            {
pixhawk's avatar
pixhawk committed
                WaypointEditableView* widget = wpEditableViews.find(waypoints[i]).value();
                if (waypoints[i]->getId() == seq)
                {
                    widget->setCurrent(true);
void WaypointList::currentWaypointViewOnlyChanged(quint16 seq)
{
    if (uas)
    {
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointViewOnlyList();

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

                if (waypoints[i]->getId() == seq)
                {
                    widget->setCurrent(true);
                }
                else
                {
                    widget->setCurrent(false);
                }
            }
        }
    }
}

void WaypointList::updateWaypointEditable(int uas, Waypoint* wp)
pixhawk's avatar
pixhawk committed
    WaypointEditableView *wpv = wpEditableViews.value(wp);
void WaypointList::updateWaypointViewOnly(int uas, Waypoint* wp)
{
    Q_UNUSED(uas);
    WaypointViewOnlyView *wpv = wpViewOnlyViews.value(wp);
    wpv->updateValues();
}

pixhawk's avatar
pixhawk committed
void WaypointList::waypointViewOnlyListChanged()
{
    if (uas) {
        // Prevent updates to prevent visual flicker
        this->setUpdatesEnabled(false);
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->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;
                    }
                }
                if (i == waypoints.size()) {
                    WaypointViewOnlyView* widget = wpViewOnlyViews.find(cur).value();
                    widget->hide();
                    viewOnlyListLayout->removeWidget(widget);
pixhawk's avatar
pixhawk committed
                    wpViewOnlyViews.remove(cur);
                }
            }
        }

        // 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);

            //check if ordering has changed
            if(viewOnlyListLayout->itemAt(i)->widget() != wpv) {
                viewOnlyListLayout->removeWidget(wpv);
                viewOnlyListLayout->insertWidget(i, wpv);
            }

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


void WaypointList::waypointEditableListChanged()
pixhawk's avatar
pixhawk committed
{
pixhawk's avatar
pixhawk committed
        // Prevent updates to prevent visual flicker
        this->setUpdatesEnabled(false);
pixhawk's avatar
pixhawk committed
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
pixhawk's avatar
pixhawk committed

pixhawk's avatar
pixhawk committed
        if (!wpEditableViews.empty()) {
            QMapIterator<Waypoint*,WaypointEditableView*> viewIt(wpEditableViews);
            while(viewIt.hasNext()) {
                viewIt.next();
                Waypoint *cur = viewIt.key();
                int i;
                for (i = 0; i < waypoints.size(); i++) {
                    if (waypoints[i] == cur) {
lm's avatar
lm committed
                    }
                }
                if (i == waypoints.size()) {
pixhawk's avatar
pixhawk committed
                    WaypointEditableView* widget = wpEditableViews.find(cur).value();
pixhawk's avatar
pixhawk committed
                    editableListLayout->removeWidget(widget);
                    wpEditableViews.remove(cur);
lm's avatar
lm committed
                }
pixhawk's avatar
pixhawk committed
            }
        }
        // then add/update the views for each waypoint in the list
        for(int i = 0; i < waypoints.size(); i++) {
pixhawk's avatar
pixhawk committed
            if (!wpEditableViews.contains(wp)) {
                WaypointEditableView* wpview = new WaypointEditableView(wp, this);
pixhawk's avatar
pixhawk committed
                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))); commented, because unused
                connect(wpview, SIGNAL(changeCurrentWaypoint(quint16)), this, SLOT(changeCurrentWaypointEditable(quint16)));
pixhawk's avatar
pixhawk committed
                editableListLayout->insertWidget(i, wpview);
pixhawk's avatar
pixhawk committed
            WaypointEditableView *wpv = wpEditableViews.value(wp);
pixhawk's avatar
pixhawk committed
            if(editableListLayout->itemAt(i)->widget() != wpv) {
                editableListLayout->removeWidget(wpv);
                editableListLayout->insertWidget(i, wpv);
lm's avatar
lm committed

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

//void WaypointList::waypointEditableListChanged()
lm's avatar
lm committed
//{
//    if (uas)
//    {
//        // Prevent updates to prevent visual flicker
//        this->setUpdatesEnabled(false);
//        // Get all waypoints
pixhawk's avatar
pixhawk committed
//        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
lm's avatar
lm committed

////        // Store the current state, then check which widgets to update
////        // and which ones to delete
pixhawk's avatar
pixhawk committed
////        QList<Waypoint*> oldWaypoints = wpEditableViews.keys();
lm's avatar
lm committed

////        foreach (Waypoint* wp, waypoints)
////        {
lm's avatar
lm committed
////            // Create any new waypoint
pixhawk's avatar
pixhawk committed
////            if (!wpEditableViews.contains(wp))
lm's avatar
lm committed
////            {
////                wpview = new WaypointEditableView(wp, this);
pixhawk's avatar
pixhawk committed
////                wpEditableViews.insert(wp, wpview);
lm's avatar
lm committed
////                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(changeCurrentWaypoint(quint16)));
pixhawk's avatar
pixhawk committed
////                editableListLayout->addWidget(wpview);
lm's avatar
lm committed
////            }
////            else
////            {
////                // Update existing waypoints
pixhawk's avatar
pixhawk committed
////                wpview = wpEditableViews.value(wp);
lm's avatar
lm committed

////            }
////            // Mark as updated by removing from old list
////            oldWaypoints.removeAt(oldWaypoints.indexOf(wp));

////            wpview->updateValues();    // update the values of the ui elements in the view

////        }

////        // The old list now contains all wps to be deleted
////        foreach (Waypoint* wp, oldWaypoints)
////        {
////            // Delete waypoint view and entry in list
pixhawk's avatar
pixhawk committed
////            WaypointEditableView* wpv = wpEditableViews.value(wp);
lm's avatar
lm committed
////            if (wpv)
////            {
pixhawk's avatar
pixhawk committed
////                editableListLayout->removeWidget(wpv);
lm's avatar
lm committed
////                delete wpv;
////            }
pixhawk's avatar
pixhawk committed
////            wpEditableViews.remove(wp);
lm's avatar
lm committed
////        }
pixhawk's avatar
pixhawk committed
//        if (!wpEditableViews.empty())
pixhawk's avatar
pixhawk committed
//        {
pixhawk's avatar
pixhawk committed
//            QMapIterator<Waypoint*,WaypointEditableView*> viewIt(wpEditableViews);
pixhawk's avatar
pixhawk committed
//            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;
//                    }
//                }
//                if (i == waypoints.size())
//                {
pixhawk's avatar
pixhawk committed
//                    WaypointEditableView* widget = wpEditableViews.find(cur).value();
lm's avatar
lm committed
//                    if (widget)
//                    {
//                        widget->hide();
pixhawk's avatar
pixhawk committed
//                        editableListLayout->removeWidget(widget);
lm's avatar
lm committed
//                    }
pixhawk's avatar
pixhawk committed
//                    wpEditableViews.remove(cur);
pixhawk's avatar
pixhawk committed
//                }
//            }
//        }
pixhawk's avatar
pixhawk committed
//        // then add/update the views for each waypoint in the list
//        for(int i = 0; i < waypoints.size(); i++)
//        {
//            Waypoint *wp = waypoints[i];
pixhawk's avatar
pixhawk committed
//            if (!wpEditableViews.contains(wp))
pixhawk's avatar
pixhawk committed
//            {
//                WaypointEditableView* wpview = new WaypointEditableView(wp, this);
pixhawk's avatar
pixhawk committed
//                wpEditableViews.insert(wp, wpview);
pixhawk's avatar
pixhawk committed
//                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(changeCurrentWaypoint(quint16)));
//            }
pixhawk's avatar
pixhawk committed
//            WaypointEditableView *wpv = wpEditableViews.value(wp);
pixhawk's avatar
pixhawk committed
//            wpv->updateValues();    // update the values of the ui elements in the view
pixhawk's avatar
pixhawk committed
//            editableListLayout->addWidget(wpv);
pixhawk's avatar
pixhawk committed

//        }
lm's avatar
lm committed
//        this->setUpdatesEnabled(true);
//    }
////    loadFileGlobalWP = false;
//}
pixhawk's avatar
pixhawk committed

void WaypointList::moveUp(Waypoint* wp)
pixhawk's avatar
pixhawk committed
{
pixhawk's avatar
pixhawk committed
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();

        //get the current position of wp in the local storage
        int i;
        for (i = 0; i < waypoints.size(); i++) {
        // if wp was found and its not the first entry, move it
        if (i < waypoints.size() && i > 0) {
pixhawk's avatar
pixhawk committed
            uas->getWaypointManager()->moveWaypoint(i, i-1);
pixhawk's avatar
pixhawk committed
        }
    }
}

void WaypointList::moveDown(Waypoint* wp)
pixhawk's avatar
pixhawk committed
{
pixhawk's avatar
pixhawk committed
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
        //get the current position of wp in the local storage
        int i;
        for (i = 0; i < waypoints.size(); i++) {
pixhawk's avatar
pixhawk committed
        }

        // if wp was found and its not the last entry, move it
        if (i < waypoints.size()-1) {
pixhawk's avatar
pixhawk committed
            uas->getWaypointManager()->moveWaypoint(i, i+1);
pixhawk's avatar
pixhawk committed
        }
    }
}

void WaypointList::removeWaypoint(Waypoint* wp)
{
pixhawk's avatar
pixhawk committed
        uas->getWaypointManager()->removeWaypoint(wp->getId());
pixhawk's avatar
pixhawk committed
    }
}

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



void WaypointList::on_clearWPListButton_clicked()
{
    if (uas) {
        emit clearPathclicked();
pixhawk's avatar
pixhawk committed
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
        while(!waypoints.isEmpty()) { //for(int i = 0; i <= waypoints.size(); i++)
pixhawk's avatar
pixhawk committed
            WaypointEditableView* widget = wpEditableViews.find(waypoints[0]).value();
            widget->remove();
lm's avatar
lm committed
//        if(isGlobalWP)
//        {
//           emit clearPathclicked();
//        }
    }
pixhawk's avatar
pixhawk committed
///** @brief The MapWidget informs that a waypoint global was changed on the map */
pixhawk's avatar
pixhawk committed
//void WaypointList::waypointGlobalChanged(QPointF coordinate, int indexWP)
//{
//    if (uas)
//    {
pixhawk's avatar
pixhawk committed
//        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
pixhawk's avatar
pixhawk committed
//        if (waypoints.size() > 0)
//        {
//            Waypoint *temp = waypoints.at(indexWP);
pixhawk's avatar
pixhawk committed
//            temp->setX(coordinate.x());
//            temp->setY(coordinate.y());
pixhawk's avatar
pixhawk committed
//            //WaypointGlobalView* widget = wpGlobalViews.find(waypoints[indexWP]).value();
//            //widget->updateValues();
//        }
//    }
pixhawk's avatar
pixhawk committed
//}
///** @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);


//}

void WaypointList::clearWPWidget()
pixhawk's avatar
pixhawk committed
        const QVector<Waypoint *> &waypoints = uas->getWaypointManager()->getWaypointEditableList();
        while(!waypoints.isEmpty()) { //for(int i = 0; i <= waypoints.size(); i++)
pixhawk's avatar
pixhawk committed
            WaypointEditableView* widget = wpEditableViews.find(waypoints[0]).value();
            widget->remove();
        }
    }
pixhawk's avatar
pixhawk committed
//void WaypointList::setIsLoadFileWP()
//{
//    loadFileGlobalWP = true;
//}
pixhawk's avatar
pixhawk committed
//void WaypointList::setIsReadGlobalWP(bool value)
//{
//    // FIXME James Check this
//    Q_UNUSED(value);
//    // readGlobalWP = value;
//}