Waypoint.cc 3.48 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

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

Waypoint::~Waypoint()
{

}

57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80
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;
}

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

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

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

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

101
void Waypoint::setYaw(float yaw)
pixhawk's avatar
pixhawk committed
102 103 104 105
{
    this->yaw = yaw;
}

106
void Waypoint::setAction(MAV_ACTION action)
James Goppert's avatar
James Goppert committed
107
{
108 109 110 111 112 113
    this->action = action;
}

void Waypoint::setFrame(MAV_FRAME frame)
{
    this->frame = frame;
James Goppert's avatar
James Goppert committed
114 115
}

pixhawk's avatar
pixhawk committed
116 117 118 119 120 121 122 123 124
void Waypoint::setAutocontinue(bool autoContinue)
{
    this->autocontinue = autoContinue;
}

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

pixhawk's avatar
pixhawk committed
126 127 128 129 130 131 132 133 134 135
void Waypoint::setOrbit(float orbit)
{
    this->orbit = orbit;
}

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

136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154
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
155 156 157 158 159

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