source: ntrip/trunk/BNC/src/bncfigureppp.cpp@ 10460

Last change on this file since 10460 was 9959, checked in by stuerze, 22 months ago

minor changes to be msvc compatible
File size: 8.6 KB
Line 
1// Part of BNC, a utility for retrieving decoding and
2// converting GNSS data streams from NTRIP broadcasters.
3//
4// Copyright (C) 2007
5// German Federal Agency for Cartography and Geodesy (BKG)
6// http://www.bkg.bund.de
7// Czech Technical University Prague, Department of Geodesy
8// http://www.fsv.cvut.cz
9//
10// Email: euref-ip@bkg.bund.de
11//
12// This program is free software; you can redistribute it and/or
13// modify it under the terms of the GNU General Public License
14// as published by the Free Software Foundation, version 2.
15//
16// This program is distributed in the hope that it will be useful,
17// but WITHOUT ANY WARRANTY; without even the implied warranty of
18// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19// GNU General Public License for more details.
20//
21// You should have received a copy of the GNU General Public License
22// along with this program; if not, write to the Free Software
23// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
24
25/* -------------------------------------------------------------------------
26 * BKG NTRIP Client
27 * -------------------------------------------------------------------------
28 *
29 * Class: bncFigurePPP
30 *
31 * Purpose:
32 *
33 * Author: Mervart
34 *
35 * Created: 11-Nov-2009
36 *
37 * Changes:
38 *
39 * -----------------------------------------------------------------------*/
40
41#include <iostream>
42
43#include <QApplication>
44#include <QPainter>
45#include <QVariant>
46
47#include "bncfigureppp.h"
48#include "bncsettings.h"
49#include "bncutils.h"
50
51using namespace std;
52
53// Constructor
54////////////////////////////////////////////////////////////////////////////
55bncFigurePPP::bncFigurePPP(QWidget *parent) : QWidget(parent) {
56 reset();
57}
58
59
60// Destructor
61////////////////////////////////////////////////////////////////////////////
62bncFigurePPP::~bncFigurePPP() {
63 for (int ii = 0; ii < _pos.size(); ++ii) {
64 delete _pos[ii];
65 }
66}
67
68//
69////////////////////////////////////////////////////////////////////////////
70void bncFigurePPP::reset() {
71 QMutexLocker locker(&_mutex);
72 for (int ii = 0; ii < _pos.size(); ++ii) {
73 delete _pos[ii];
74 }
75 _pos.clear();
76 update();
77}
78
79//
80////////////////////////////////////////////////////////////////////////////
81void bncFigurePPP::slotNewPosition(QByteArray staID, bncTime time, QVector<double> xx){
82
83 QMutexLocker locker(&_mutex);
84
85 bncSettings settings;
86
87 if (settings.value("PPP/audioResponse").toString() != "" ) {
88 _audioResponseThreshold = settings.value("PPP/audioResponse").toDouble();
89 }
90 else {
91 _audioResponseThreshold = 0.0;
92 }
93
94 if (settings.value("PPP/plotCoordinates").toByteArray() != staID) {
95 return;
96 }
97
98 pppPos* newPos = new pppPos;
99
100 newPos->time = time;
101 newPos->neu[0] = xx.data()[3];
102 newPos->neu[1] = xx.data()[4];
103 newPos->neu[2] = xx.data()[5];
104
105 _pos.push_back(newPos);
106
107 if (_pos.size() == 1) {
108 _startTime = time;
109 }
110
111 QMutableVectorIterator<pppPos*> it(_pos);
112 while (it.hasNext()) {
113 pppPos* pp = it.next();
114 if ( (time - pp->time) > _tRange ) {
115 delete pp;
116 it.remove();
117 }
118 }
119
120 update();
121}
122
123// Coordinate Transformation
124////////////////////////////////////////////////////////////////////////////
125QPoint bncFigurePPP::pltPoint(double tt, double yy) {
126
127 double tScale = 0.90 * _width / _tRange;
128 double yScale = 0.90 * _height / (2.0 * _neuMax);
129 double tOffset = _tRange / 13.0;
130 double yOffset = _neuMax / 10.0;
131
132 int tNew = int( ( tt - _tMin + tOffset) * tScale );
133 int yNew = int( (-yy + _neuMax + yOffset) * yScale );
134
135 return QPoint(tNew, yNew);
136}
137
138//
139////////////////////////////////////////////////////////////////////////////
140void bncFigurePPP::paintEvent(QPaintEvent *) {
141
142 QPainter painter(this);
143
144 _width = painter.viewport().width();
145 _height = painter.viewport().height();
146
147 QFont font = this->font();
148 font.setPointSize(int(this->font().pointSize()*0.9));
149 painter.setFont(font);
150
151 // Plot X-coordinates as a function of time (in seconds)
152 // -----------------------------------------------------
153 if (_pos.size() > 1) {
154 _tMin = _pos[0]->time.gpssec();
155
156 // North, East and Up differences wrt Reference Coordinates
157 // --------------------------------------------------------
158 _neuMax = 0.0;
159 vector< vector<double> > neu(_pos.size(), vector<double>(3));
160 for (int ii = 0; ii < _pos.size(); ++ii) {
161 for (int ic = 0; ic < 3; ++ic) {
162 neu[ii][ic] = _pos[ii]->neu[ic];
163 if (fabs(neu[ii][ic]) > _neuMax) {
164 _neuMax = fabs(neu[ii][ic]);
165 }
166 }
167 }
168
169 if (_neuMax > 0.0) {
170
171 if (_neuMax < 0.151) {
172 _neuMax = 0.151;
173 }
174
175 unsigned hour, minute;
176 double second;
177 int ww = QFontMetrics(this->font()).width('w');
178
179 // neu components
180 // --------------
181 for (int ii = 1; ii < _pos.size(); ++ii) {
182 double t1 = _tMin + (_pos[ii-1]->time - _pos[0]->time);
183 double t2 = _tMin + (_pos[ii]->time - _pos[0]->time);
184
185 // Audio response
186 // --------------
187 if ( ii == _pos.size()-1) {
188 if ( _audioResponseThreshold > 0.0 &&
189 (fabs(neu[ii-1][0]) > _audioResponseThreshold ||
190 fabs(neu[ii-1][1]) > _audioResponseThreshold) ) {
191 QApplication::beep();
192 }
193 }
194
195 // dots
196 // ----
197 painter.setPen(QColor(Qt::gray));
198 painter.drawLine(pltPoint(t1, neu[ii-1][0]), pltPoint(t2, neu[ii][0]));
199 painter.setPen(QColor(Qt::red));
200 painter.setBrush(QColor(Qt::red));
201 painter.drawEllipse(pltPoint(t1,neu[ii-1][0]), ww/6, ww/6);
202
203 painter.setPen(QColor(Qt::gray));
204 painter.drawLine(pltPoint(t1, neu[ii-1][1]), pltPoint(t2, neu[ii][1]));
205 painter.setPen(QColor(Qt::green));
206 painter.setBrush(QColor(Qt::green));
207 painter.drawEllipse(pltPoint(t1,neu[ii-1][1]), ww/6, ww/6);
208
209 painter.setPen(QColor(Qt::gray));
210 painter.drawLine(pltPoint(t1, neu[ii-1][2]), pltPoint(t2, neu[ii][2]));
211 painter.setPen(QColor(Qt::blue));
212 painter.setBrush(QColor(Qt::blue));
213 painter.drawEllipse(pltPoint(t1,neu[ii-1][2]), ww/6, ww/6);
214
215 // time-tics
216 // ---------
217 if ( fmod(_pos[ii-1]->time.daysec(), 60.0) == 0 ) {
218 _pos[ii-1]->time.civil_time(hour, minute, second);
219 QPoint pntTic = pltPoint(t1, 0.0);
220 QString strTic = QString("%1:%2").arg(hour, 2, 10, QChar('0'))
221 .arg(minute, 2, 10, QChar('0'));
222 double xFirstCharTic = pntTic.x() - ww * 1.2;
223 if ( xFirstCharTic > pltPoint(_tMin, 0.0).x()) {
224 painter.setPen(QColor(Qt::black));
225 painter.drawText(int(xFirstCharTic), int(pntTic.y() + ww * 1.7),
226 strTic);
227 painter.drawLine(pntTic.x(), pntTic.y(),
228 pntTic.x(), pntTic.y()+ww/2);
229 }
230 }
231 }
232
233 // time-axis
234 // ---------
235 painter.setPen(QColor(Qt::black));
236 painter.drawLine(pltPoint(_tMin, 0.0), pltPoint(_tMin+_tRange, 0.0));
237
238 // neu-axis
239 // --------
240 painter.drawLine(pltPoint(_tMin, -_neuMax), pltPoint(_tMin, _neuMax));
241
242 // neu-tics
243 // --------
244 double tic = floor(20.0 * (_neuMax - 0.05)) / 20.0;
245 QString strP = QString("%1 m").arg( tic,0,'f',2);
246 QString strM = QString("%1 m").arg(-tic,0,'f',2);
247 QString strZ = QString("%1 m").arg(0.0,0,'f',2);
248
249 QPoint pntP = pltPoint(_tMin, tic);
250 QPoint pntM = pltPoint(_tMin,-tic);
251 QPoint pntZ = pltPoint(_tMin, 0.0);
252
253 painter.setPen(QColor(Qt::red));
254 painter.drawText(0, ww, pntP.x() + 3*ww, pntP.x(), Qt::AlignRight, "N");
255 painter.setPen(QColor(Qt::green));
256 painter.drawText(0, ww, pntP.x() + 4*ww, pntP.x(), Qt::AlignRight, "E");
257 painter.setPen(QColor(Qt::blue));
258 painter.drawText(0, ww, pntP.x() + 5*ww, pntP.x(), Qt::AlignRight, "U");
259
260 painter.setPen(QColor(Qt::black));
261 painter.drawText(0, pntP.y()-ww/2, pntP.x()- ww/4, pntP.x(),
262 Qt::AlignRight, strP);
263 painter.drawText(0, pntM.y()-ww/2, pntM.x()- ww/4, pntM.x(),
264 Qt::AlignRight, strM);
265 painter.drawText(0, pntZ.y()-ww/2, pntZ.x()- ww/4, pntZ.x(),
266 Qt::AlignRight, strZ);
267
268 painter.drawLine(pntP.x(), pntP.y(), pntP.x()+ww, pntP.y());
269 painter.drawLine(pntM.x(), pntM.y(), pntM.x()+ww, pntM.y());
270
271 // Start Time
272 // ----------
273 QString startStr = QString(_startTime.timestr(0).c_str());
274 startStr = "Start " + startStr;
275 painter.setPen(QColor(Qt::black));
276 painter.drawText(0, ww, pntP.x() + 31*ww, pntP.x(), Qt::AlignRight, startStr);
277 }
278 }
279}
280
Note: See TracBrowser for help on using the repository browser.