// Part of BNC, a utility for retrieving decoding and
// converting GNSS data streams from NTRIP broadcasters.
//
// Copyright (C) 2007
// German Federal Agency for Cartography and Geodesy (BKG)
// http://www.bkg.bund.de
// Czech Technical University Prague, Department of Geodesy
// http://www.fsv.cvut.cz
//
// Email: euref-ip@bkg.bund.de
//
// 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, version 2.
//
// 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 for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
/* -------------------------------------------------------------------------
* BKG NTRIP Client
* -------------------------------------------------------------------------
*
* Class: bncFigurePPP
*
* Purpose:
*
* Author: Mervart
*
* Created: 11-Nov-2009
*
* Changes:
*
* -----------------------------------------------------------------------*/
#include <iostream>
#include <QApplication>
#include <QPainter>
#include <QVariant>
#include "bncfigureppp.h"
#include "bncsettings.h"
#include "bncutils.h"
using namespace std;
// Constructor
////////////////////////////////////////////////////////////////////////////
bncFigurePPP::bncFigurePPP(QWidget *parent) : QWidget(parent) {
reset();
}
// Destructor
////////////////////////////////////////////////////////////////////////////
bncFigurePPP::~bncFigurePPP() {
for (int ii = 0; ii < _pos.size(); ++ii) {
delete _pos[ii];
}
}
//
////////////////////////////////////////////////////////////////////////////
void bncFigurePPP::reset() {
QMutexLocker locker(&_mutex);
for (int ii = 0; ii < _pos.size(); ++ii) {
delete _pos[ii];
}
_pos.clear();
update();
}
//
////////////////////////////////////////////////////////////////////////////
void bncFigurePPP::slotNewPosition(QByteArray staID, bncTime time, QVector<double> xx){
QMutexLocker locker(&_mutex);
bncSettings settings;
if (settings.value("PPP/audioResponse").toString() != "" ) {
_audioResponseThreshold = settings.value("PPP/audioResponse").toDouble();
}
else {
_audioResponseThreshold = 0.0;
}
if (settings.value("PPP/plotCoordinates").toByteArray() != staID) {
return;
}
pppPos* newPos = new pppPos;
newPos->time = time;
newPos->neu[0] = xx.data()[3];
newPos->neu[1] = xx.data()[4];
newPos->neu[2] = xx.data()[5];
_pos.push_back(newPos);
if (_pos.size() == 1) {
_startTime = time;
}
QMutableVectorIterator<pppPos*> it(_pos);
while (it.hasNext()) {
pppPos* pp = it.next();
if ( (time - pp->time) > _tRange ) {
delete pp;
it.remove();
}
}
update();
}
// Coordinate Transformation
////////////////////////////////////////////////////////////////////////////
QPoint bncFigurePPP::pltPoint(double tt, double yy) {
double tScale = 0.90 * _width / _tRange;
double yScale = 0.90 * _height / (2.0 * _neuMax);
double tOffset = _tRange / 13.0;
double yOffset = _neuMax / 10.0;
int tNew = int( ( tt - _tMin + tOffset) * tScale );
int yNew = int( (-yy + _neuMax + yOffset) * yScale );
return QPoint(tNew, yNew);
}
//
////////////////////////////////////////////////////////////////////////////
void bncFigurePPP::paintEvent(QPaintEvent *) {
QPainter painter(this);
_width = painter.viewport().width();
_height = painter.viewport().height();
QFont font = this->font();
font.setPointSize(int(this->font().pointSize()*0.9));
painter.setFont(font);
// Plot X-coordinates as a function of time (in seconds)
// -----------------------------------------------------
if (_pos.size() > 1) {
_tMin = _pos[0]->time.gpssec();
// North, East and Up differences wrt Reference Coordinates
// --------------------------------------------------------
_neuMax = 0.0;
vector< vector<double> > neu(_pos.size(), vector<double>(3));
for (int ii = 0; ii < _pos.size(); ++ii) {
for (int ic = 0; ic < 3; ++ic) {
neu[ii][ic] = _pos[ii]->neu[ic];
if (fabs(neu[ii][ic]) > _neuMax) {
_neuMax = fabs(neu[ii][ic]);
}
}
}
if (_neuMax > 0.0) {
if (_neuMax < 0.151) {
_neuMax = 0.151;
}
unsigned hour, minute;
double second;
int ww = QFontMetrics(this->font()).horizontalAdvance('w');
// neu components
// --------------
for (int ii = 1; ii < _pos.size(); ++ii) {
double t1 = _tMin + (_pos[ii-1]->time - _pos[0]->time);
double t2 = _tMin + (_pos[ii]->time - _pos[0]->time);
// Audio response
// --------------
if ( ii == _pos.size()-1) {
if ( _audioResponseThreshold > 0.0 &&
(fabs(neu[ii-1][0]) > _audioResponseThreshold ||
fabs(neu[ii-1][1]) > _audioResponseThreshold) ) {
QApplication::beep();
}
}
// dots
// ----
painter.setPen(QColor(Qt::gray));
painter.drawLine(pltPoint(t1, neu[ii-1][0]), pltPoint(t2, neu[ii][0]));
painter.setPen(QColor(Qt::red));
painter.setBrush(QColor(Qt::red));
painter.drawEllipse(pltPoint(t1,neu[ii-1][0]), ww/6, ww/6);
painter.setPen(QColor(Qt::gray));
painter.drawLine(pltPoint(t1, neu[ii-1][1]), pltPoint(t2, neu[ii][1]));
painter.setPen(QColor(Qt::green));
painter.setBrush(QColor(Qt::green));
painter.drawEllipse(pltPoint(t1,neu[ii-1][1]), ww/6, ww/6);
painter.setPen(QColor(Qt::gray));
painter.drawLine(pltPoint(t1, neu[ii-1][2]), pltPoint(t2, neu[ii][2]));
painter.setPen(QColor(Qt::blue));
painter.setBrush(QColor(Qt::blue));
painter.drawEllipse(pltPoint(t1,neu[ii-1][2]), ww/6, ww/6);
// time-tics
// ---------
if ( fmod(_pos[ii-1]->time.daysec(), 60.0) == 0 ) {
_pos[ii-1]->time.civil_time(hour, minute, second);
QPoint pntTic = pltPoint(t1, 0.0);
QString strTic = QString("%1:%2").arg(hour, 2, 10, QChar('0'))
.arg(minute, 2, 10, QChar('0'));
double xFirstCharTic = pntTic.x() - ww * 1.2;
if ( xFirstCharTic > pltPoint(_tMin, 0.0).x()) {
painter.setPen(QColor(Qt::black));
painter.drawText(int(xFirstCharTic), int(pntTic.y() + ww * 1.7),
strTic);
painter.drawLine(pntTic.x(), pntTic.y(),
pntTic.x(), pntTic.y()+ww/2);
}
}
}
// time-axis
// ---------
painter.setPen(QColor(Qt::black));
painter.drawLine(pltPoint(_tMin, 0.0), pltPoint(_tMin+_tRange, 0.0));
// neu-axis
// --------
painter.drawLine(pltPoint(_tMin, -_neuMax), pltPoint(_tMin, _neuMax));
// neu-tics
// --------
double tic = floor(20.0 * (_neuMax - 0.05)) / 20.0;
QString strP = QString("%1 m").arg( tic,0,'f',2);
QString strM = QString("%1 m").arg(-tic,0,'f',2);
QString strZ = QString("%1 m").arg(0.0,0,'f',2);
QPoint pntP = pltPoint(_tMin, tic);
QPoint pntM = pltPoint(_tMin,-tic);
QPoint pntZ = pltPoint(_tMin, 0.0);
painter.setPen(QColor(Qt::red));
painter.drawText(0, ww, pntP.x() + 3*ww, pntP.x(), Qt::AlignRight, "N");
painter.setPen(QColor(Qt::green));
painter.drawText(0, ww, pntP.x() + 4*ww, pntP.x(), Qt::AlignRight, "E");
painter.setPen(QColor(Qt::blue));
painter.drawText(0, ww, pntP.x() + 5*ww, pntP.x(), Qt::AlignRight, "U");
painter.setPen(QColor(Qt::black));
painter.drawText(0, pntP.y()-ww/2, pntP.x()- ww/4, pntP.x(),
Qt::AlignRight, strP);
painter.drawText(0, pntM.y()-ww/2, pntM.x()- ww/4, pntM.x(),
Qt::AlignRight, strM);
painter.drawText(0, pntZ.y()-ww/2, pntZ.x()- ww/4, pntZ.x(),
Qt::AlignRight, strZ);
painter.drawLine(pntP.x(), pntP.y(), pntP.x()+ww, pntP.y());
painter.drawLine(pntM.x(), pntM.y(), pntM.x()+ww, pntM.y());
// Start Time
// ----------
QString startStr = QString(_startTime.timestr(0).c_str());
startStr = "Start " + startStr;
painter.setPen(QColor(Qt::black));
painter.drawText(0, ww, pntP.x() + 31*ww, pntP.x(), Qt::AlignRight, startStr);
}
}
}