source: ntrip/trunk/BNC/GPSS/gpssDecoder.cpp@ 1437

Last change on this file since 1437 was 1437, checked in by mervart, 15 years ago

* empty log message *
File size: 3.9 KB
Line 
1\
2/* -------------------------------------------------------------------------
3 * BKG NTRIP Client
4 * -------------------------------------------------------------------------
5 *
6 * Class: gpssDecoder
7 *
8 * Purpose: Decode Data in GPSS Format
9 *
10 * Author: L. Mervart
11 *
12 * Created: 20-Dec-2008
13 *
14 * Changes:
15 *
16 * -----------------------------------------------------------------------*/
17
18#include "gpssDecoder.h"
19#include "bncapp.h"
20
21#define MODE_SEARCH 0
22#define MODE_TYPE 1
23#define MODE_EPOCH 2
24#define MODE_EPOCH_BODY 3
25#define MODE_EPOCH_CRC 4
26#define MODE_EPOCH_ETX 5
27#define MODE_EPH 6
28#define MODE_EPH_BODY 7
29#define MODE_EPH_CRC 8
30#define MODE_EPH_ETX 9
31
32using namespace std;
33
34typedef struct epochHeader {
35 double t_epoch;
36 int n_svs;
37} EPOCHHEADER;
38
39// Cyclic Redundancy Check
40////////////////////////////////////////////////////////////////////////////
41unsigned short cal_crc(unsigned char *buf, int num) {
42 unsigned short polynomial = 0x8408;
43 unsigned short crc = 0;
44 int i;
45 while ( num-- ) {
46 crc = ( crc & 0xFF00 ) | ( *buf++^( crc & 0x00FF ) );
47 for( i=0; i<8; i++ ){
48 if( crc & 0x0001 ){
49 crc >>= 1;
50 crc ^= polynomial;
51 }
52 else{
53 crc >>= 1;
54 }
55 }
56 }
57 return (crc);
58}
59
60// Constructor
61////////////////////////////////////////////////////////////////////////////
62gpssDecoder::gpssDecoder() : GPSDecoder() {
63 _mode = MODE_SEARCH;
64
65 connect(this, SIGNAL(newGPSEph(gpsephemeris*)),
66 (bncApp*) qApp, SLOT(slotNewGPSEph(gpsephemeris*)));
67}
68
69// Destructor
70////////////////////////////////////////////////////////////////////////////
71gpssDecoder::~gpssDecoder() {
72}
73
74//
75////////////////////////////////////////////////////////////////////////////
76t_irc gpssDecoder::Decode(char* data, int dataLen, vector<string>& errmsg) {
77
78 errmsg.clear();
79
80 _buffer += QByteArray(data, dataLen);
81
82 int iBeg;
83 while ( (iBeg = _buffer.indexOf(0x02)) != -1) {
84 _buffer = _buffer.mid(iBeg);
85
86 int recordSize;
87 int crc;
88
89 // Observations
90 // ------------
91 if (char(_buffer[1]) == 0x00) {
92
93 int reqLength = 2 + sizeof(recordSize) + sizeof(EPOCHHEADER);
94
95 if (_buffer.length() >= reqLength) {
96 EPOCHHEADER epochHdr;
97 memcpy(&epochHdr, _buffer.data() + 2 + sizeof(recordSize),
98 sizeof(epochHdr));
99
100 reqLength += epochHdr.n_svs * sizeof(t_obsInternal) + sizeof(crc) + 1;
101
102 if (_buffer.length() >= reqLength) {
103
104 int checkLen = 2 + sizeof(recordSize) + sizeof(EPOCHHEADER) +
105 epochHdr.n_svs * sizeof(t_obsInternal);
106 memcpy(&crc, _buffer.data() + checkLen, sizeof(crc));
107 int crcCal = cal_crc((unsigned char*) _buffer.data(), checkLen);
108
109 if (crc == crcCal) {
110 for (int is = 0; is < epochHdr.n_svs; is++) {
111 t_obs* obs = new t_obs();
112 memcpy(&(obs->_o), _buffer.data() + 2 + sizeof(recordSize) +
113 sizeof(epochHdr) + is * sizeof(t_obsInternal),
114 sizeof(t_obsInternal));
115 _obsList.push_back(obs);
116 }
117 }
118 }
119 }
120 _buffer = _buffer.mid(reqLength);
121 }
122
123 // Ephemeris
124 // ---------
125 else if (char(_buffer[1]) == 0x01) {
126 int reqLength = 2 + sizeof(recordSize) + sizeof(gpsephemeris) +
127 sizeof(crc) + 1;
128
129 if (_buffer.length() >= reqLength) {
130
131 int checkLen = 2 + sizeof(recordSize) + sizeof(gpsephemeris);
132 memcpy(&crc, _buffer.data() + checkLen, sizeof(crc));
133 int crcCal = cal_crc((unsigned char*) _buffer.data(), checkLen);
134
135 if (crc == crcCal) {
136 gpsephemeris* gpsEph = new gpsephemeris;
137 memcpy(gpsEph, _buffer.data() + 2 + sizeof(recordSize),
138 sizeof(gpsephemeris));
139 emit newGPSEph(gpsEph);
140 }
141 }
142 _buffer = _buffer.mid(reqLength);
143 }
144
145 else {
146 _buffer == _buffer.mid(1);
147 }
148 }
149
150 return success;
151}
Note: See TracBrowser for help on using the repository browser.