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 |
|
---|
32 | using namespace std;
|
---|
33 |
|
---|
34 | typedef struct epochHeader {
|
---|
35 | double t_epoch;
|
---|
36 | int n_svs;
|
---|
37 | } EPOCHHEADER;
|
---|
38 |
|
---|
39 | // Constructor
|
---|
40 | ////////////////////////////////////////////////////////////////////////////
|
---|
41 | gpssDecoder::gpssDecoder() : GPSDecoder() {
|
---|
42 | _mode = MODE_SEARCH;
|
---|
43 |
|
---|
44 | connect(this, SIGNAL(newGPSEph(gpsephemeris*)),
|
---|
45 | (bncApp*) qApp, SLOT(slotNewGPSEph(gpsephemeris*)));
|
---|
46 | }
|
---|
47 |
|
---|
48 | // Destructor
|
---|
49 | ////////////////////////////////////////////////////////////////////////////
|
---|
50 | gpssDecoder::~gpssDecoder() {
|
---|
51 | }
|
---|
52 |
|
---|
53 | //
|
---|
54 | ////////////////////////////////////////////////////////////////////////////
|
---|
55 | t_irc gpssDecoder::Decode(char* data, int dataLen, vector<string>& errmsg) {
|
---|
56 |
|
---|
57 | errmsg.clear();
|
---|
58 |
|
---|
59 | _buffer += QByteArray(data, dataLen);
|
---|
60 |
|
---|
61 | int iBeg;
|
---|
62 | while ( (iBeg = _buffer.indexOf(0x02)) != -1) {
|
---|
63 | _buffer = _buffer.mid(iBeg);
|
---|
64 |
|
---|
65 | // Record Size
|
---|
66 | // -----------
|
---|
67 | int recordSize;
|
---|
68 | if (_buffer.length() >= int(2 + sizeof(recordSize)) &&
|
---|
69 | ( char(_buffer[1]) == 0x00 || char(_buffer[1]) == 0x01) ) {
|
---|
70 | memcpy(&recordSize, _buffer.data()+2, sizeof(recordSize));
|
---|
71 | }
|
---|
72 | else {
|
---|
73 | break;
|
---|
74 | }
|
---|
75 |
|
---|
76 | // Observations
|
---|
77 | // ------------
|
---|
78 | if (char(_buffer[1]) == 0x00) {
|
---|
79 | EPOCHHEADER epochHdr;
|
---|
80 | if (_buffer.length() >= int(2 + sizeof(recordSize) + sizeof(epochHdr))) {
|
---|
81 | memcpy(&epochHdr, _buffer.data() + 2 + sizeof(recordSize),
|
---|
82 | sizeof(epochHdr));
|
---|
83 |
|
---|
84 | if (_buffer.length() >= int(2 + sizeof(recordSize) + sizeof(epochHdr) +
|
---|
85 | epochHdr.n_svs * sizeof(t_obsInternal))) {
|
---|
86 | for (int is = 1; is <= epochHdr.n_svs; is++) {
|
---|
87 | t_obs* obs = new t_obs();
|
---|
88 | memcpy(&(obs->_o), _buffer.data(), sizeof(t_obsInternal));
|
---|
89 | _obsList.push_back(obs);
|
---|
90 | }
|
---|
91 | }
|
---|
92 | }
|
---|
93 | }
|
---|
94 |
|
---|
95 | // Ephemeris
|
---|
96 | // ---------
|
---|
97 | else if (char(_buffer[1]) == 0x01) {
|
---|
98 | if (_buffer.length() >= int(2+sizeof(recordSize)+ sizeof(gpsephemeris))){
|
---|
99 | gpsephemeris* gpsEph = new gpsephemeris;
|
---|
100 | memcpy(gpsEph, _buffer.data(), sizeof(gpsephemeris));
|
---|
101 | emit newGPSEph(gpsEph);
|
---|
102 | }
|
---|
103 | }
|
---|
104 |
|
---|
105 | else {
|
---|
106 | _buffer == _buffer.mid(1);
|
---|
107 | }
|
---|
108 | }
|
---|
109 |
|
---|
110 | return success;
|
---|
111 | }
|
---|