MAV2DIcon.cc 2.11 KB
Newer Older
1 2 3
#include "MAV2DIcon.h"
#include <QPainter>

4 5 6
MAV2DIcon::MAV2DIcon(qreal x, qreal y, int radius, QString name, Alignment alignment, QPen* pen)
    : Point(x, y, name, alignment),
    yaw(0.0f)
7
{
8 9
    size = QSize(radius, radius);
    drawIcon(pen);
10 11
}

12 13 14 15 16
MAV2DIcon::MAV2DIcon(qreal x, qreal y, QString name, Alignment alignment, QPen* pen)
    : Point(x, y, name, alignment)
{
    int radius = 10;
    size = QSize(radius, radius);
17 18 19 20
    if (pen)
    {
        drawIcon(pen);
    }
21 22 23 24 25 26 27 28
}

MAV2DIcon::~MAV2DIcon()
{
    delete mypixmap;
}

void MAV2DIcon::setPen(QPen* pen)
29
{
30 31 32 33 34
    if (pen)
    {
        mypen = pen;
        drawIcon(pen);
    }
35 36 37
}

/**
38
 * @param yaw in radians, 0 = north, positive = clockwise
39
 */
40
void MAV2DIcon::setYaw(float yaw)
41
{
42 43 44 45 46
    this->yaw = yaw;
}

void MAV2DIcon::drawIcon(QPen* pen)
{
47 48 49
    if (pen)
    {
        mypixmap = new QPixmap(radius+1, radius+1);
50
        //mypixmap->fill(Qt::transparent);
51
        QPainter painter(mypixmap);
52

53 54
        // DRAW MICRO AIR VEHICLE
        QPointF p(radius/2, radius/2);
55

56 57 58 59 60 61 62 63
        float waypointSize = radius;
        QPolygonF poly(3);
        // Top point
        poly.replace(0, QPointF(p.x(), p.y()+waypointSize/2.0f));
        // Right point
        poly.replace(1, QPointF(p.x()-waypointSize/2.0f, p.y()-waypointSize/2.0f));
        // Left point
        poly.replace(2, QPointF(p.x()+waypointSize/2.0f, p.y() + waypointSize/2.0f));
64

65 66 67 68 69 70 71 72 73 74 75
        //    // Select color based on if this is the current waypoint
        //    if (list.at(i)->getCurrent())
        //    {
        //        color = QGC::colorCyan;//uas->getColor();
        //        pen.setWidthF(refLineWidthToPen(0.8f));
        //    }
        //    else
        //    {
        //        color = uas->getColor();
        //        pen.setWidthF(refLineWidthToPen(0.4f));
        //    }
76

77 78 79 80 81 82 83 84 85 86 87 88 89 90
        //pen.setColor(color);
        if (pen)
        {
            pen->setWidthF(2);
            painter.setPen(*pen);
        }
        else
        {
            QPen pen2(Qt::yellow);
            pen2.setWidth(2);
            painter.setPen(pen2);
        }
        painter.setBrush(Qt::NoBrush);
        painter.drawPolygon(poly);
91
    }
92
}