[758] | 1 | /* -------------------------------------------------------------------------
|
---|
| 2 | * BKG NTRIP Server
|
---|
| 3 | * -------------------------------------------------------------------------
|
---|
| 4 | *
|
---|
| 5 | * Class: bnseph
|
---|
| 6 | *
|
---|
| 7 | * Purpose: Retrieve broadcast ephemeris from BNC
|
---|
| 8 | *
|
---|
| 9 | * Author: L. Mervart
|
---|
| 10 | *
|
---|
| 11 | * Created: 29-Mar-2008
|
---|
| 12 | *
|
---|
| 13 | * Changes:
|
---|
| 14 | *
|
---|
| 15 | * -----------------------------------------------------------------------*/
|
---|
| 16 |
|
---|
[761] | 17 | #include <iostream>
|
---|
[776] | 18 | #include <math.h>
|
---|
[761] | 19 |
|
---|
[758] | 20 | #include "bnseph.h"
|
---|
[776] | 21 | #include "bnsutils.h"
|
---|
[758] | 22 |
|
---|
| 23 | using namespace std;
|
---|
| 24 |
|
---|
| 25 | // Constructor
|
---|
| 26 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 27 | t_bnseph::t_bnseph(QObject* parent) : QThread(parent) {
|
---|
[839] | 28 |
|
---|
| 29 | this->setTerminationEnabled(true);
|
---|
| 30 |
|
---|
[830] | 31 | _socket = 0;
|
---|
[758] | 32 | }
|
---|
| 33 |
|
---|
| 34 | // Destructor
|
---|
| 35 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 36 | t_bnseph::~t_bnseph() {
|
---|
[759] | 37 | delete _socket;
|
---|
[758] | 38 | }
|
---|
| 39 |
|
---|
[838] | 40 | // Connect the Socket
|
---|
[758] | 41 | ////////////////////////////////////////////////////////////////////////////
|
---|
[838] | 42 | void t_bnseph::reconnect() {
|
---|
[759] | 43 |
|
---|
[838] | 44 | delete _socket;
|
---|
[759] | 45 |
|
---|
[830] | 46 | QSettings settings;
|
---|
| 47 | QString host = "localhost";
|
---|
| 48 | int port = settings.value("ephPort").toInt();
|
---|
| 49 |
|
---|
| 50 | _socket = new QTcpSocket();
|
---|
| 51 | _socket->connectToHost(host, port);
|
---|
| 52 |
|
---|
[838] | 53 | const int timeOut = 10*1000; // 10 seconds
|
---|
[830] | 54 | if (!_socket->waitForConnected(timeOut)) {
|
---|
[838] | 55 | emit(newMessage("bnseph::run Connect Timeout"));
|
---|
[830] | 56 | }
|
---|
[838] | 57 | }
|
---|
| 58 |
|
---|
| 59 | // Start
|
---|
| 60 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 61 | void t_bnseph::run() {
|
---|
| 62 |
|
---|
| 63 | emit(newMessage("bnseph::run Start"));
|
---|
| 64 |
|
---|
| 65 | while (true) {
|
---|
| 66 | if (_socket == 0 || _socket->state() != QAbstractSocket::ConnectedState) {
|
---|
| 67 | reconnect();
|
---|
| 68 | }
|
---|
| 69 | if (_socket && _socket->state() == QAbstractSocket::ConnectedState) {
|
---|
[830] | 70 | if (_socket->canReadLine()) {
|
---|
| 71 | readEph();
|
---|
| 72 | }
|
---|
| 73 | else {
|
---|
| 74 | _socket->waitForReadyRead(10);
|
---|
| 75 | }
|
---|
[759] | 76 | }
|
---|
[838] | 77 | else {
|
---|
| 78 | msleep(10);
|
---|
| 79 | }
|
---|
[759] | 80 | }
|
---|
[758] | 81 | }
|
---|
| 82 |
|
---|
[771] | 83 | // Read One Ephemeris
|
---|
| 84 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 85 | void t_bnseph::readEph() {
|
---|
| 86 |
|
---|
[778] | 87 | gpsEph* ep = new gpsEph;
|
---|
[771] | 88 |
|
---|
[782] | 89 | bool flagGlonass = false;
|
---|
| 90 |
|
---|
[781] | 91 | const int NUMLINES = 8;
|
---|
[771] | 92 |
|
---|
[781] | 93 | for (int ii = 1; ii <= NUMLINES; ii++) {
|
---|
[771] | 94 |
|
---|
[781] | 95 | QByteArray line = _socket->readLine();
|
---|
[782] | 96 |
|
---|
| 97 | if (flagGlonass) {
|
---|
| 98 | if (ii == 4) {
|
---|
| 99 | delete ep;
|
---|
| 100 | return;
|
---|
| 101 | }
|
---|
| 102 | else {
|
---|
| 103 | continue;
|
---|
| 104 | }
|
---|
| 105 | }
|
---|
| 106 |
|
---|
[781] | 107 | QTextStream in(line);
|
---|
[778] | 108 |
|
---|
[781] | 109 | if (ii == 1) {
|
---|
[782] | 110 | in >> ep->prn;
|
---|
| 111 |
|
---|
| 112 | if (ep->prn.indexOf('R') != -1) {
|
---|
| 113 | flagGlonass = true;
|
---|
| 114 | continue;
|
---|
| 115 | }
|
---|
| 116 |
|
---|
[800] | 117 | double year, month, day, hour, minute, second;
|
---|
[782] | 118 | in >> year >> month >> day >> hour >> minute >> second
|
---|
[781] | 119 | >> ep->clock_bias >> ep->clock_drift >> ep->clock_driftrate;
|
---|
| 120 |
|
---|
| 121 | if (year < 100) year += 2000;
|
---|
| 122 |
|
---|
[805] | 123 | QDateTime dateTime(QDate(int(year), int(month), int(day)),
|
---|
| 124 | QTime(int(hour), int(minute), int(second)), Qt::UTC);
|
---|
[800] | 125 | int week;
|
---|
| 126 | GPSweekFromDateAndTime(dateTime, week, ep->TOC);
|
---|
| 127 | ep->GPSweek = week;
|
---|
[781] | 128 | }
|
---|
| 129 | else if (ii == 2) {
|
---|
| 130 | in >> ep->IODE >> ep->Crs >> ep->Delta_n >> ep->M0;
|
---|
| 131 | }
|
---|
| 132 | else if (ii == 3) {
|
---|
| 133 | in >> ep->Cuc >> ep->e >> ep->Cus >> ep->sqrt_A;
|
---|
| 134 | }
|
---|
| 135 | else if (ii == 4) {
|
---|
| 136 | in >> ep->TOE >> ep->Cic >> ep->OMEGA0 >> ep->Cis;
|
---|
| 137 | }
|
---|
| 138 | else if (ii == 5) {
|
---|
| 139 | in >> ep->i0 >> ep->Crc >> ep->omega >> ep->OMEGADOT;
|
---|
| 140 | }
|
---|
| 141 | else if (ii == 6) {
|
---|
[800] | 142 | in >> ep->IDOT;
|
---|
[781] | 143 | }
|
---|
| 144 | else if (ii == 7) {
|
---|
[800] | 145 | double hlp, health;
|
---|
| 146 | in >> hlp >> health >> ep->TGD >> ep->IODC;
|
---|
[781] | 147 | }
|
---|
| 148 | else if (ii == 8) {
|
---|
| 149 | in >> ep->TOW;
|
---|
| 150 | }
|
---|
| 151 | }
|
---|
[773] | 152 |
|
---|
[778] | 153 | emit(newEph(ep));
|
---|
[771] | 154 | }
|
---|