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

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

* empty log message *
File size: 3.5 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// Constructor
40////////////////////////////////////////////////////////////////////////////
41gpssDecoder::gpssDecoder() : GPSDecoder() {
42 _mode = MODE_SEARCH;
43
44 connect(this, SIGNAL(newGPSEph(gpsephemeris*)),
45 (bncApp*) qApp, SLOT(slotNewGPSEph(gpsephemeris*)));
46}
47
48// Destructor
49////////////////////////////////////////////////////////////////////////////
50gpssDecoder::~gpssDecoder() {
51}
52
53//
54////////////////////////////////////////////////////////////////////////////
55t_irc gpssDecoder::Decode(char* data, int dataLen, vector<string>& errmsg) {
56
57 errmsg.clear();
58
59 if (_mode == MODE_SEARCH) {
60 _buffer.clear();
61 }
62 _buffer.append(data, dataLen);
63
64 for (;;) {
65
66 if (_buffer.size() < 1) {
67 _mode = MODE_SEARCH;
68 return success;
69 }
70
71 if (_mode == MODE_SEARCH) {
72 if (_buffer[0] == 0x02) {
73 _mode = MODE_TYPE;
74 }
75 else {
76 _mode = MODE_SEARCH;
77 }
78 _buffer.erase(0,1);
79 }
80
81 else if (_mode == MODE_TYPE) {
82 if (_buffer[0] == 0x00) {
83 _mode = MODE_EPOCH;
84 } else if (_buffer[0] == 0x01) {
85 _mode = MODE_EPH;
86 } else {
87 _mode = MODE_SEARCH;
88 }
89 _buffer.erase(0,1);
90 }
91
92 else if (_mode == MODE_EPOCH || _mode == MODE_EPH) {
93 int recordSize;
94 if (_buffer.size() < sizeof(recordSize)) {
95 _mode = MODE_SEARCH;
96 return success;
97 }
98 memcpy(&recordSize, _buffer.data(), sizeof(recordSize));
99 if (_mode == MODE_EPOCH) {
100 _mode = MODE_EPOCH_BODY;
101 }
102 if (_mode == MODE_EPH) {
103 _mode = MODE_EPH_BODY;
104 }
105 _buffer.erase(0,sizeof(recordSize));
106 }
107
108 else if (_mode == MODE_EPOCH_BODY) {
109 EPOCHHEADER epochHdr;
110 if (_buffer.size() < sizeof(epochHdr)) {
111 _mode = MODE_SEARCH;
112 return success;
113 }
114 memcpy(&epochHdr, _buffer.data(), sizeof(epochHdr));
115 _buffer.erase(0,sizeof(epochHdr));
116 if (_buffer.size() < epochHdr.n_svs * sizeof(t_obsInternal)) {
117 _mode = MODE_SEARCH;
118 return success;
119 }
120 for (int is = 1; is <= epochHdr.n_svs; is++) {
121 t_obs* obs = new t_obs();
122 memcpy(&(obs->_o), _buffer.data(), sizeof(t_obsInternal));
123 _obsList.push_back(obs);
124 _buffer.erase(0, sizeof(t_obsInternal));
125 }
126 _mode = MODE_EPOCH_CRC;
127 }
128
129 else if (_mode == MODE_EPH_BODY) {
130 if (_buffer.size() < sizeof(gpsephemeris)) {
131 _mode = MODE_SEARCH;
132 return success;
133 }
134 gpsephemeris* gpsEph = new gpsephemeris;
135 memcpy(gpsEph, _buffer.data(), sizeof(gpsephemeris));
136 emit newGPSEph(gpsEph);
137 _buffer.erase(0, sizeof(gpsephemeris));
138 _mode = MODE_EPH_CRC;
139 }
140
141 else {
142 _buffer.erase(0,1);
143 _mode = MODE_SEARCH;
144 }
145 }
146
147 return success;
148}
Note: See TracBrowser for help on using the repository browser.