You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
183 lines
5.3 KiB
183 lines
5.3 KiB
/////////////////////////////////////////////////////////////////////////////////// |
|
// Copyright (C) 2023 Jon Beniston, M7RCE <jon@beniston.com> // |
|
// // |
|
// This program 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 as version 3 of the License, or // |
|
// (at your option) any later version. // |
|
// // |
|
// This program 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 V3 for more details. // |
|
// // |
|
// You should have received a copy of the GNU General Public License // |
|
// along with this program. If not, see <http://www.gnu.org/licenses/>. // |
|
/////////////////////////////////////////////////////////////////////////////////// |
|
|
|
#include <cmath> |
|
|
|
#include <QPainter> |
|
|
|
#include "coursedeviationindicator.h" |
|
|
|
CourseDeviationIndicator::CourseDeviationIndicator(QWidget *parent) : |
|
QWidget(parent), |
|
m_localizerDDM(0.0f), |
|
m_glideSlopeDDM(0.0f), |
|
m_mode(LOC) |
|
{ |
|
} |
|
|
|
void CourseDeviationIndicator::setMode(Mode mode) |
|
{ |
|
m_mode = mode; |
|
update(); |
|
} |
|
|
|
void CourseDeviationIndicator::setLocalizerDDM(float ddm) |
|
{ |
|
m_localizerDDM = ddm; |
|
update(); |
|
} |
|
|
|
void CourseDeviationIndicator::setGlideSlopeDDM(float ddm) |
|
{ |
|
m_glideSlopeDDM = ddm; |
|
update(); |
|
} |
|
|
|
void CourseDeviationIndicator::paintEvent(QPaintEvent *event) |
|
{ |
|
(void) event; |
|
|
|
QPainter painter(this); |
|
|
|
QRect r = rect(); |
|
int midW = r.width() / 2; |
|
int midH = r.height() / 2; |
|
int spacing; |
|
|
|
// A320 like CDI |
|
|
|
// Black background |
|
int bgw, bgh; |
|
if (m_mode == LOC) |
|
{ |
|
bgw = r.width(); |
|
bgh = 20; |
|
painter.fillRect(0, midH - bgh, bgw, bgh*2, QColor(0, 0, 0)); |
|
} |
|
else |
|
{ |
|
bgw = 20; |
|
bgh = r.height(); |
|
painter.fillRect(midW - bgw, 0, bgw*2, bgh, QColor(0, 0, 0)); |
|
} |
|
|
|
const int dots = 5; |
|
|
|
// Circles |
|
painter.setPen(QColor(255, 255, 255)); |
|
const int radius = 4; |
|
int x, y; |
|
|
|
if (m_mode == LOC) |
|
{ |
|
spacing = r.width() / 5; |
|
x = spacing / 2; |
|
y = midH; |
|
} |
|
else |
|
{ |
|
spacing = r.height() / 5; |
|
x = midW; |
|
y = spacing / 2; |
|
} |
|
for (int i = 0; i < dots; i++) |
|
{ |
|
if (i != 2) { |
|
painter.drawEllipse(QPointF(x, y), radius, radius); |
|
} |
|
if (m_mode == LOC) { |
|
x += spacing; |
|
} else { |
|
y += spacing; |
|
} |
|
} |
|
|
|
// Diamond (index) - only draw half of symbol if out of range |
|
// Shouldn't draw the symbol if signal not vaiid |
|
// Typically, LOC full scale deflection 0.155 DDM (Which is ~2.5deg, so 1 deg per dot, but can be 3 degrees. A320 is 0.8 deg per dot) |
|
// For GS, full deflection is 0.0875 DDM (0.7deg, so 0.14 deg per dot) |
|
painter.setPen(QColor(255, 150, 250)); |
|
float dev; |
|
if (m_mode == LOC) { |
|
dev = m_localizerDDM / 0.155; |
|
} else { |
|
dev = m_glideSlopeDDM / 0.0875; |
|
} |
|
dev = std::min(dev, 1.0f); |
|
dev = std::max(dev, -1.0f); |
|
if (m_mode == LOC) |
|
{ |
|
x = midW + dev * r.width() / 2; // Positive DDM means we're to left of course line |
|
y = midH; |
|
} |
|
else |
|
{ |
|
x = midW; |
|
y = midH + dev * r.height() / 2; // Positive DDM means we're above glide path |
|
} |
|
int dw = 10; |
|
int dh = 8; |
|
painter.drawLine(x, y + dh, x - dw, y); |
|
painter.drawLine(x - dw, y, x, y - dh); |
|
painter.drawLine(x + dw, y, x, y - dh); |
|
painter.drawLine(x, y + dh, x + dw, y); |
|
|
|
// Centre line |
|
painter.setPen(QColor(255, 255, 70)); |
|
if (m_mode == LOC) |
|
{ |
|
int lh = 14; |
|
painter.drawLine(midW, midH + lh, midW, midH - lh); |
|
painter.drawLine(midW-1, midH + lh, midW-1, midH - lh); |
|
painter.drawLine(midW+1, midH + lh, midW+1, midH - lh); |
|
} |
|
else |
|
{ |
|
int lw = 14; |
|
painter.drawLine(midW + lw, midH, midW - lw, midH); |
|
painter.drawLine(midW + lw, midH - 1, midW - lw, midH - 1); |
|
painter.drawLine(midW + lw, midH + 1, midW - lw, midH + 1); |
|
} |
|
|
|
if (m_mode == LOC) |
|
{ |
|
// Indicate localizer capture |
|
if (std::abs(m_localizerDDM) < 0.175) // See 3.1.3.7.4 |
|
{ |
|
QFontMetrics fm(painter.font()); |
|
QString text = "LOC"; |
|
int tw = fm.horizontalAdvance(text); |
|
int th = fm.descent(); |
|
painter.setPen(QColor(0, 255, 0)); |
|
painter.drawText(midW - tw/2, midH - bgh - th, text); |
|
} |
|
} |
|
else |
|
{ |
|
// Indicate glideslope capture |
|
if (std::abs(m_glideSlopeDDM) < 0.175) // Can't see a spec for this |
|
{ |
|
QFontMetrics fm(painter.font()); |
|
QString text = "G/S"; |
|
int th = fm.ascent() / 2; |
|
painter.setPen(QColor(0, 255, 0)); |
|
painter.drawText(midW + bgw + 2, midH + th, text); |
|
} |
|
} |
|
|
|
} |
|
|
|
|