Waypoint.h 3.76 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
/*=====================================================================

PIXHAWK Micro Air Vehicle Flying Robotics Toolkit

(c) 2009 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 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 34 35 36 37
 *
 */

#ifndef WAYPOINT_H
#define WAYPOINT_H

#include <QObject>
#include <QString>
38
#include <QTextStream>
lm's avatar
lm committed
39
#include "QGCMAVLink.h"
pixhawk's avatar
pixhawk committed
40 41 42 43

class Waypoint : public QObject
{
    Q_OBJECT
44

pixhawk's avatar
pixhawk committed
45
public:
pixhawk's avatar
pixhawk committed
46 47
    Waypoint(quint16 id = 0, double x = 0.0f, double y = 0.0f, double z = 0.0f, double yaw = 0.0f, bool autocontinue = false,
             bool current = false, double orbit = 0.15f, int holdTime = 0,
lm's avatar
lm committed
48
             MAV_FRAME frame=MAV_FRAME_GLOBAL, MAV_COMMAND action=MAV_CMD_NAV_WAYPOINT);
pixhawk's avatar
pixhawk committed
49 50
    ~Waypoint();

51
    quint16 getId() const { return id; }
pixhawk's avatar
pixhawk committed
52 53 54 55
    double getX() const { return x; }
    double getY() const { return y; }
    double getZ() const { return z; }
    double getYaw() const { return yaw; }
56 57
    bool getAutoContinue() const { return autocontinue; }
    bool getCurrent() const { return current; }
58 59 60 61 62
    double getLoiterOrbit() const { return orbit; }
    double getAcceptanceRadius() const { return param1; }
    double getHoldTime() const { return param2; }
    double getParam1() const { return param1; }
    double getParam2() const { return param2; }
63
    double getParam3() const { return orbit; }
lm's avatar
lm committed
64 65 66 67
    double getParam4() const { return yaw; }
    double getParam5() const { return x; }
    double getParam6() const { return y; }
    double getParam7() const { return z; }
68
    int getTurns() const { return param1; }
69
    MAV_FRAME getFrame() const { return frame; }
lm's avatar
lm committed
70
    MAV_COMMAND getAction() const { return action; }
71
    const QString& getName() const { return name; }
72

73 74 75 76
    void save(QTextStream &saveStream);
    bool load(QTextStream &loadStream);


77
protected:
78
    quint16 id;
pixhawk's avatar
pixhawk committed
79 80 81 82
    double x;
    double y;
    double z;
    double yaw;
83
    MAV_FRAME frame;
lm's avatar
lm committed
84
    MAV_COMMAND action;
pixhawk's avatar
pixhawk committed
85 86
    bool autocontinue;
    bool current;
pixhawk's avatar
pixhawk committed
87
    double orbit;
88 89 90
    double param1;
    double param2;
    int turns;
91
    QString name;
pixhawk's avatar
pixhawk committed
92 93

public slots:
94
    void setId(quint16 id);
pixhawk's avatar
pixhawk committed
95 96 97 98
    void setX(double x);
    void setY(double y);
    void setZ(double z);
    void setYaw(double yaw);
99 100
    /** @brief Set the waypoint action */
    void setAction(int action);
lm's avatar
lm committed
101
    void setAction(MAV_COMMAND action);
102
    void setFrame(MAV_FRAME frame);
pixhawk's avatar
pixhawk committed
103 104
    void setAutocontinue(bool autoContinue);
    void setCurrent(bool current);
105 106 107 108 109
    void setLoiterOrbit(double orbit);
    void setParam1(double param1);
    void setParam2(double param2);
    void setParam3(double param3);
    void setParam4(double param4);
110 111
    void setParam5(double param5);
    void setParam6(double param6);
lm's avatar
lm committed
112
    void setParam7(double param7);
113
    void setAcceptanceRadius(double radius);
pixhawk's avatar
pixhawk committed
114
    void setHoldTime(int holdTime);
115 116
    /** @brief Number of turns for loiter waypoints */
    void setTurns(int turns);
117 118 119 120

signals:
    /** @brief Announces a change to the waypoint data */
    void changed(Waypoint* wp);
pixhawk's avatar
pixhawk committed
121 122 123
};

#endif // WAYPOINT_H