magicwaypointgadgetwidget.cpp

Go to the documentation of this file.

/*
 * This program 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.
 *
 * This program 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 this program; if not, see <http://www.gnu.org/licenses/>
 */
#include "magicwaypointgadgetwidget.h"
#include "ui_magicwaypoint.h"

#include <QDebug>
#include <QString>
#include <QStringList>
#include <QWidget>
#include <QTextEdit>
#include <QVBoxLayout>
#include <QPushButton>

#include "uavobjects/uavobject.h"
#include "uavobjects/uavobjectmanager.h"
#include "manualcontrolcommand.h"
#include "extensionsystem/pluginmanager.h"
#include "extensionsystem/pluginmanager.h"

MagicWaypointGadgetWidget::MagicWaypointGadgetWidget(QWidget *parent)
    : QLabel(parent)
{
    m_magicwaypoint = new Ui_MagicWaypoint();
    m_magicwaypoint->setupUi(this);

    // Connect object updated event from UAVObject to also update check boxes
    connect(getPathDesired(), SIGNAL(objectUpdated(UAVObject *)), this,
            SLOT(pathDesiredChanged(UAVObject *)));
    connect(getPositionActual(), SIGNAL(objectUpdated(UAVObject *)), this,
            SLOT(positionActualChanged(UAVObject *)));

    // Connect updates from the position widget to this widget
    connect(m_magicwaypoint->widgetPosition, SIGNAL(positionClicked(double, double)), this,
            SLOT(positionSelected(double, double)));
    connect(this, SIGNAL(positionActualObjectChanged(double, double)),
            m_magicwaypoint->widgetPosition, SLOT(updateActualIndicator(double, double)));
    connect(this, SIGNAL(positionDesiredObjectChanged(double, double)),
            m_magicwaypoint->widgetPosition, SLOT(updateDesiredIndicator(double, double)));

    // Catch changes in scale for visualization
    connect(m_magicwaypoint->horizontalSliderScale, SIGNAL(valueChanged(int)), this,
            SLOT(scaleChanged(int)));

    // Make sure the scale is correctly visualized
    m_magicwaypoint->horizontalSliderScale->setValue(10);
}

MagicWaypointGadgetWidget::~MagicWaypointGadgetWidget()
{
    // Do nothing
}

PathDesired *MagicWaypointGadgetWidget::getPathDesired()
{
    ExtensionSystem::PluginManager *pm = ExtensionSystem::PluginManager::instance();
    UAVObjectManager *objManager = pm->getObject<UAVObjectManager>();
    PathDesired *obj = PathDesired::GetInstance(objManager);
    Q_ASSERT(obj != NULL); // Save crashes later
    return obj;
}

PositionActual *MagicWaypointGadgetWidget::getPositionActual()
{
    ExtensionSystem::PluginManager *pm = ExtensionSystem::PluginManager::instance();
    UAVObjectManager *objManager = pm->getObject<UAVObjectManager>();
    PositionActual *obj = PositionActual::GetInstance(objManager);
    Q_ASSERT(obj != NULL);
    return obj;
}

void MagicWaypointGadgetWidget::scaleChanged(int scale)
{
    Q_UNUSED(scale);
    pathDesiredChanged(getPathDesired());
    positionActualChanged(getPositionActual());
}

void MagicWaypointGadgetWidget::positionActualChanged(UAVObject *)
{
    PositionActual::DataFields positionActual = getPositionActual()->getData();
    double scale = m_magicwaypoint->horizontalSliderScale->value();

    emit positionActualObjectChanged(positionActual.North / scale, positionActual.East / scale);
}

void MagicWaypointGadgetWidget::pathDesiredChanged(UAVObject *)
{
    PathDesired::DataFields pathDesired = getPathDesired()->getData();
    double scale = m_magicwaypoint->horizontalSliderScale->value();

    emit positionDesiredObjectChanged(pathDesired.End[PathDesired::END_NORTH] / scale,
                                      pathDesired.End[PathDesired::END_EAST] / scale);
}

void MagicWaypointGadgetWidget::positionSelected(double north, double east)
{
    double scale = m_magicwaypoint->horizontalSliderScale->value();

    PathDesired::DataFields pathDesired = getPathDesired()->getData();
    pathDesired.End[PathDesired::END_NORTH] = north * scale;
    pathDesired.End[PathDesired::END_EAST] = east * scale;
    pathDesired.Mode = PathDesired::MODE_ENDPOINT;
    getPathDesired()->setData(pathDesired);
}