[3575] | 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());
|
---|