HSIDisplay.h 2.87 KB
Newer Older
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 29 30 31 32 33 34 35 36 37 38 39 40 41 42
/*=====================================================================

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 Definition of of Horizontal Situation Indicator class
 *
 *   @author Lorenz Meier <mavteam@student.ethz.ch>
 *
 */

#ifndef HSIDISPLAY_H
#define HSIDISPLAY_H

#include <QtGui/QWidget>
#include <QColor>
#include <QTimer>
#include <QMap>
#include <QPair>
#include <cmath>

#include "HDDisplay.h"
lm's avatar
lm committed
43
#include "MG.h"
44 45 46 47

class HSIDisplay : public HDDisplay {
    Q_OBJECT
public:
48
    HSIDisplay(QWidget *parent = 0);
lm's avatar
lm committed
49
    // ~HSIDisplay();
50 51 52

public slots:
    void setActiveUAS(UASInterface* uas);
lm's avatar
lm committed
53
    void updateSatellite(int uasid, int satid, float azimuth, float direction, float snr, bool used);
lm's avatar
lm committed
54
    void paintEvent(QPaintEvent * event);
55 56 57

protected slots:
    void paintDisplay();
lm's avatar
lm committed
58 59 60 61
    void drawGPS();
    void drawObjects();
    void drawBaseLines(float xRef, float yRef, float radius, float yaw, const QColor& color, QPainter* painter, bool solid);

62 63

protected:
lm's avatar
lm committed
64 65 66 67 68 69 70 71
    static QColor getColorForSNR(float snr);

    /**
     * @brief Private data container class to be used within the HSI widget
     */
    class GPSSatellite
    {
    public:
lm's avatar
lm committed
72
        GPSSatellite(int id, float elevation, float azimuth, float snr, bool used) :
lm's avatar
lm committed
73
                id(id),
lm's avatar
lm committed
74
                elevation(elevation),
lm's avatar
lm committed
75 76
                azimuth(azimuth),
                snr(snr),
lm's avatar
lm committed
77 78
                used(used),
                lastUpdate(MG::TIME::getGroundTimeNowUsecs())
lm's avatar
lm committed
79 80 81 82
        {

        }

lm's avatar
lm committed
83
        void update(int id, float elevation, float azimuth, float snr, bool used)
lm's avatar
lm committed
84 85
        {
            this->id = id;
lm's avatar
lm committed
86
            this->elevation = elevation;
lm's avatar
lm committed
87 88 89
            this->azimuth = azimuth;
            this->snr = snr;
            this->used = used;
lm's avatar
lm committed
90
            this->lastUpdate = MG::TIME::getGroundTimeNowUsecs();
lm's avatar
lm committed
91 92 93
        }

        int id;
lm's avatar
lm committed
94
        float elevation;
lm's avatar
lm committed
95 96 97
        float azimuth;
        float snr;
        bool used;
lm's avatar
lm committed
98
        quint64 lastUpdate;
lm's avatar
lm committed
99 100 101 102

        friend class HSIDisplay;
    };

lm's avatar
lm committed
103
    QMap<int, GPSSatellite*> gpsSatellites;
pixhawk's avatar
pixhawk committed
104
    unsigned int satellitesUsed;
105 106 107 108 109

private:
};

#endif // HSIDISPLAY_H