1 | Index: GPSS/hassDecoder.cpp |
---|
2 | =================================================================== |
---|
3 | 82c82,91 |
---|
4 | < //// beg test |
---|
5 | --- |
---|
6 | > t_eph* eph = 0; |
---|
7 | > if (_eph.contains(prn)) { |
---|
8 | > if (_eph.value(prn)->last && _eph.value(prn)->last->IOD() == IOD) { |
---|
9 | > eph = _eph.value(prn)->last; |
---|
10 | > } |
---|
11 | > else if (_eph.value(prn)->prev && _eph.value(prn)->prev->IOD() == IOD) { |
---|
12 | > eph = _eph.value(prn)->prev; |
---|
13 | > } |
---|
14 | > } |
---|
15 | > if (!eph) { |
---|
16 | 84,96c93 |
---|
17 | < //// end test |
---|
18 | < //// t_eph* eph = 0; |
---|
19 | < //// if (_eph.contains(prn)) { |
---|
20 | < //// if (_eph.value(prn)->last && _eph.value(prn)->last->IOD() == IOD) { |
---|
21 | < //// eph = _eph.value(prn)->last; |
---|
22 | < //// } |
---|
23 | < //// else if (_eph.value(prn)->prev && _eph.value(prn)->prev->IOD() == IOD) { |
---|
24 | < //// eph = _eph.value(prn)->prev; |
---|
25 | < //// } |
---|
26 | < //// } |
---|
27 | < //// if (!eph) { |
---|
28 | < //// continue; |
---|
29 | < //// } |
---|
30 | --- |
---|
31 | > } |
---|
32 | 100c97 |
---|
33 | < //// eph->position(tt.gpsw(), tt.gpssec(), xc.data(), vv.data()); |
---|
34 | --- |
---|
35 | > eph->position(tt.gpsw(), tt.gpssec(), xc.data(), vv.data()); |
---|
36 | Index: RTCM3/RTCM3coDecoder.h |
---|
37 | =================================================================== |
---|
38 | 32a33 |
---|
39 | > #include "bncephuser.h" |
---|
40 | 39c40 |
---|
41 | < class RTCM3coDecoder : public QObject, public GPSDecoder { |
---|
42 | --- |
---|
43 | > class RTCM3coDecoder : public bncEphUser, public GPSDecoder { |
---|
44 | Index: RTCM/RTCM2Decoder.h |
---|
45 | =================================================================== |
---|
46 | 36a37 |
---|
47 | > #include "bncephuser.h" |
---|
48 | 38c39 |
---|
49 | < class RTCM2Decoder: public GPSDecoder { |
---|
50 | --- |
---|
51 | > class RTCM2Decoder: public bncEphUser, public GPSDecoder { |
---|
52 | 45,47d45 |
---|
53 | < bool storeEph(const gpsephemeris& gpseph, std::string& storedPRN, std::vector<int>& IODs); |
---|
54 | < bool storeEph(const t_ephGPS& gpseph, std::string& storedPRN, std::vector<int>& IODs); |
---|
55 | < |
---|
56 | 60,121d57 |
---|
57 | < class t_ephList { |
---|
58 | < public: |
---|
59 | < t_ephList() {} |
---|
60 | < |
---|
61 | < ~t_ephList() { |
---|
62 | < for (std::list<t_eph*>::iterator ii = _eph.begin(); ii != _eph.end(); ii++) { |
---|
63 | < delete (*ii); |
---|
64 | < } |
---|
65 | < } |
---|
66 | < |
---|
67 | < bool store(t_eph* eph) { |
---|
68 | < if ( _eph.size() == 0 ) { |
---|
69 | < _eph.push_back(eph); |
---|
70 | < return true; |
---|
71 | < } |
---|
72 | < |
---|
73 | < std::list<t_eph*>::iterator ii = _eph.begin(); |
---|
74 | < while (ii != _eph.end()) { |
---|
75 | < if ( eph->IOD() == (*ii)->IOD() ) { |
---|
76 | < return false; |
---|
77 | < } |
---|
78 | < if ( ! eph->isNewerThan(*ii) ) { |
---|
79 | < break; |
---|
80 | < } |
---|
81 | < ++ii; |
---|
82 | < } |
---|
83 | < |
---|
84 | < if ( ii == _eph.begin() && _eph.size() == MAXSIZE) { |
---|
85 | < return false; |
---|
86 | < } |
---|
87 | < |
---|
88 | < _eph.insert(ii, eph); |
---|
89 | < |
---|
90 | < while ( _eph.size() > MAXSIZE ) { |
---|
91 | < delete _eph.front(); |
---|
92 | < _eph.pop_front(); |
---|
93 | < } |
---|
94 | < |
---|
95 | < return true; |
---|
96 | < } |
---|
97 | < |
---|
98 | < const t_eph* getEph(int IOD) const { |
---|
99 | < for (std::list<t_eph*>::const_iterator ii = _eph.begin(); ii != _eph.end(); ii++) { |
---|
100 | < if ( (*ii)->IOD() == IOD ) { |
---|
101 | < return (*ii); |
---|
102 | < } |
---|
103 | < } |
---|
104 | < return 0; |
---|
105 | < } |
---|
106 | < |
---|
107 | < void getIODs(std::vector<int>& IODs) const { |
---|
108 | < IODs.clear(); |
---|
109 | < for (std::list<t_eph*>::const_iterator ii = _eph.begin(); ii != _eph.end(); ii++) { |
---|
110 | < IODs.push_back((*ii)->IOD()); |
---|
111 | < } |
---|
112 | < } |
---|
113 | < |
---|
114 | < static const unsigned MAXSIZE = 5; |
---|
115 | < |
---|
116 | < std::list<t_eph*> _eph; |
---|
117 | < }; |
---|
118 | < |
---|
119 | 138,140d73 |
---|
120 | < std::map<std::string, t_ephList*> _ephList; |
---|
121 | < |
---|
122 | < typedef std::map<std::string, t_ephList*> t_listMap; |
---|
123 | Index: RTCM/RTCM2Decoder.cpp |
---|
124 | =================================================================== |
---|
125 | 67,69d66 |
---|
126 | < for (t_listMap::iterator ii = _ephList.begin(); ii != _ephList.end(); ii++) { |
---|
127 | < delete ii->second; |
---|
128 | < } |
---|
129 | 224,257d220 |
---|
130 | < |
---|
131 | < |
---|
132 | < bool RTCM2Decoder::storeEph(const gpsephemeris& gpseph, string& storedPRN, vector<int>& IODs) { |
---|
133 | < t_ephGPS eph; eph.set(&gpseph); |
---|
134 | < |
---|
135 | < return storeEph(eph, storedPRN, IODs); |
---|
136 | < } |
---|
137 | < |
---|
138 | < |
---|
139 | < bool RTCM2Decoder::storeEph(const t_ephGPS& gpseph, string& storedPRN, vector<int>& IODs) { |
---|
140 | < t_ephGPS* eph = new t_ephGPS(gpseph); |
---|
141 | < |
---|
142 | < string prn = eph->prn().toAscii().data(); |
---|
143 | < |
---|
144 | < t_listMap::iterator ip = _ephList.find(prn); |
---|
145 | < if (ip == _ephList.end() ) { |
---|
146 | < ip = _ephList.insert(pair<string, t_ephList*>(prn, new t_ephList)).first; |
---|
147 | < } |
---|
148 | < t_ephList* ephList = ip->second; |
---|
149 | < |
---|
150 | < bool stored = ephList->store(eph); |
---|
151 | < |
---|
152 | < if ( stored ) { |
---|
153 | < storedPRN = string(eph->prn().toAscii().data()); |
---|
154 | < ephList->getIODs(IODs); |
---|
155 | < return true; |
---|
156 | < } |
---|
157 | < |
---|
158 | < delete eph; |
---|
159 | < |
---|
160 | < return false; |
---|
161 | < } |
---|
162 | < |
---|
163 | < |
---|
164 | 299a263,269 |
---|
165 | > QString prn; |
---|
166 | > if (corr->PRN < 200) { |
---|
167 | > prn = 'G' + QString("%1").arg(corr->PRN, 2, 10, QChar('0')); |
---|
168 | > } |
---|
169 | > else { |
---|
170 | > prn = 'R' + QString("%1").arg(corr->PRN - 200, 2, 10, QChar('0')); |
---|
171 | > } |
---|
172 | 301,308c271 |
---|
173 | < ostringstream oPRN; oPRN.fill('0'); |
---|
174 | < |
---|
175 | < oPRN << (corr->PRN < 200 ? 'G' : 'R') |
---|
176 | < << setw(2) << (corr->PRN < 200 ? corr->PRN : corr->PRN - 200); |
---|
177 | < |
---|
178 | < string PRN(oPRN.str()); |
---|
179 | < |
---|
180 | < t_listMap::const_iterator ieph = _ephList.find(PRN); |
---|
181 | --- |
---|
182 | > const t_ephPair* ePair = ephPair(prn); |
---|
183 | 358,359c321,327 |
---|
184 | < if ( ieph != _ephList.end() ) { |
---|
185 | < eph = ieph->second->getEph(IODcorr); |
---|
186 | --- |
---|
187 | > if (ePair) { |
---|
188 | > if (ePair->last && ePair->last->IOD() == IODcorr) { |
---|
189 | > eph = ePair->last; |
---|
190 | > } |
---|
191 | > else if (ePair->prev && ePair->prev->IOD() == IODcorr) { |
---|
192 | > eph = ePair->prev; |
---|
193 | > } |
---|
194 | 433c401 |
---|
195 | < errmsg.push_back("missing eph for " + PRN + " , IODs " + missingIODstr.str()); |
---|
196 | --- |
---|
197 | > errmsg.push_back("missing eph for " + string(prn.toAscii().data()) + " , IODs " + missingIODstr.str()); |
---|