Waypoint.cc 3.25 KB
Newer Older
pixhawk's avatar
pixhawk committed
1 2
/*=====================================================================

pixhawk's avatar
pixhawk committed
3
QGroundControl Open Source Ground Control Station
pixhawk's avatar
pixhawk committed
4

pixhawk's avatar
pixhawk committed
5
(c) 2009, 2010 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
pixhawk's avatar
pixhawk committed
6

pixhawk's avatar
pixhawk committed
7
This file is part of the QGROUNDCONTROL project
pixhawk's avatar
pixhawk committed
8

pixhawk's avatar
pixhawk committed
9
    QGROUNDCONTROL is free software: you can redistribute it and/or modify
pixhawk's avatar
pixhawk committed
10 11 12 13
    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's avatar
pixhawk committed
14
    QGROUNDCONTROL is distributed in the hope that it will be useful,
pixhawk's avatar
pixhawk committed
15 16 17 18 19
    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
pixhawk's avatar
pixhawk committed
20
    along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.
pixhawk's avatar
pixhawk committed
21 22 23 24 25 26 27 28

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

/**
 * @file
 *   @brief Waypoint class
 *
 *   @author Benjamin Knecht <mavteam@student.ethz.ch>
29
 *   @author Petri Tanskanen <mavteam@student.ethz.ch>
pixhawk's avatar
pixhawk committed
30 31 32 33
 *
 */

#include "Waypoint.h"
34
#include <QStringList>
pixhawk's avatar
pixhawk committed
35

pixhawk's avatar
pixhawk committed
36 37 38 39 40 41 42 43 44 45
Waypoint::Waypoint(quint16 _id, float _x, float _y, float _z, float _yaw, bool _autocontinue, bool _current, float _orbit, int _holdTime)
: id(_id),
  x(_x),
  y(_y),
  z(_z),
  yaw(_yaw),
  autocontinue(_autocontinue),
  current(_current),
  orbit(_orbit),
  holdTime(_holdTime)
pixhawk's avatar
pixhawk committed
46 47 48 49 50 51 52 53
{
}

Waypoint::~Waypoint()
{

}

54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77
void Waypoint::save(QTextStream &saveStream)
{
    saveStream << "\t" << this->getId() << "\t" << this->getX() << "\t" << this->getY()  << "\t" << this->getZ()  << "\t" << this->getYaw()  << "\t" << this->getAutoContinue() << "\t" << this->getCurrent() << "\t" << this->getOrbit() << "\t" << this->getHoldTime() << "\n";
}

bool Waypoint::load(QTextStream &loadStream)
{
    const QStringList &wpParams = loadStream.readLine().split("\t");
    if (wpParams.size() == 10)
    {
        this->id = wpParams[1].toInt();
        this->x = wpParams[2].toDouble();
        this->y = wpParams[3].toDouble();
        this->z = wpParams[4].toDouble();
        this->yaw = wpParams[5].toDouble();
        this->autocontinue = (wpParams[6].toInt() == 1 ? true : false);
        this->current = (wpParams[7].toInt() == 1 ? true : false);
        this->orbit = wpParams[8].toDouble();
        this->holdTime = wpParams[9].toInt();
        return true;
    }
    return false;
}

78

79
void Waypoint::setId(quint16 id)
pixhawk's avatar
pixhawk committed
80
{
81
    this->id = id;
pixhawk's avatar
pixhawk committed
82 83
}

84
void Waypoint::setX(float x)
pixhawk's avatar
pixhawk committed
85 86 87 88
{
    this->x = x;
}

89
void Waypoint::setY(float y)
pixhawk's avatar
pixhawk committed
90 91 92 93
{
    this->y = y;
}

94
void Waypoint::setZ(float z)
pixhawk's avatar
pixhawk committed
95 96 97 98
{
    this->z = z;
}

99
void Waypoint::setYaw(float yaw)
pixhawk's avatar
pixhawk committed
100 101 102 103 104 105 106 107 108 109 110 111 112
{
    this->yaw = yaw;
}

void Waypoint::setAutocontinue(bool autoContinue)
{
    this->autocontinue = autoContinue;
}

void Waypoint::setCurrent(bool current)
{
    this->current = current;
}
113

pixhawk's avatar
pixhawk committed
114 115 116 117 118 119 120 121 122 123
void Waypoint::setOrbit(float orbit)
{
    this->orbit = orbit;
}

void Waypoint::setHoldTime(int holdTime)
{
    this->holdTime = holdTime;
}

124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142
void Waypoint::setX(double x)
{
    this->x = x;
}

void Waypoint::setY(double y)
{
    this->y = y;
}

void Waypoint::setZ(double z)
{
    this->z = z;
}

void Waypoint::setYaw(double yaw)
{
    this->yaw = yaw;
}
pixhawk's avatar
pixhawk committed
143 144 145 146 147

void Waypoint::setOrbit(double orbit)
{
    this->orbit = orbit;
}