1 |
|
---|
2 | #ifndef BNCCOMB_H
|
---|
3 | #define BNCCOMB_H
|
---|
4 |
|
---|
5 | #include <fstream>
|
---|
6 | #include <map>
|
---|
7 | #include <newmat.h>
|
---|
8 | #include "bncephuser.h"
|
---|
9 | #include "satObs.h"
|
---|
10 | #include "bncconst.h"
|
---|
11 | #include "../RTCM3/clock_and_orbit/clock_orbit_rtcm.h"
|
---|
12 | #include "../RTCM3/clock_and_orbit/clock_orbit_igs.h"
|
---|
13 |
|
---|
14 | class bncRtnetDecoder;
|
---|
15 | class bncSP3;
|
---|
16 | class bncAntex;
|
---|
17 |
|
---|
18 | class bncComb : public QObject {
|
---|
19 | Q_OBJECT
|
---|
20 | public:
|
---|
21 | bncComb();
|
---|
22 | virtual ~bncComb();
|
---|
23 | static bncComb* instance();
|
---|
24 | int nStreams() const {return _ACs.size();}
|
---|
25 |
|
---|
26 | public slots:
|
---|
27 | void slotProviderIDChanged(QString mountPoint);
|
---|
28 | void slotNewOrbCorrections(QList<t_orbCorr> orbCorrections);
|
---|
29 | void slotNewClkCorrections(QList<t_clkCorr> clkCorrections);
|
---|
30 | void slotNewCodeBiases(QList<t_satCodeBias> satCodeBiases);
|
---|
31 |
|
---|
32 | signals:
|
---|
33 | void newMessage(QByteArray msg, bool showOnScreen);
|
---|
34 | void newOrbCorrections(QList<t_orbCorr>);
|
---|
35 | void newClkCorrections(QList<t_clkCorr>);
|
---|
36 | void newCodeBiases(QList<t_satCodeBias>);
|
---|
37 |
|
---|
38 | private:
|
---|
39 | enum e_method{singleEpoch, filter};
|
---|
40 |
|
---|
41 | class cmbParam {
|
---|
42 | public:
|
---|
43 | enum parType {offACgnss, offACSat, clkSat};
|
---|
44 | cmbParam(parType type_, int index_, const QString& ac_, const QString& prn_);
|
---|
45 | ~cmbParam();
|
---|
46 | double partial(char sys, const QString& AC_, const QString& prn_);
|
---|
47 | QString toString(char sys) const;
|
---|
48 | parType type;
|
---|
49 | int index;
|
---|
50 | QString AC;
|
---|
51 | QString prn;
|
---|
52 | double xx;
|
---|
53 | double sig0;
|
---|
54 | double sigP;
|
---|
55 | bool epoSpec;
|
---|
56 | const t_eph* eph;
|
---|
57 | };
|
---|
58 |
|
---|
59 | class cmbAC {
|
---|
60 | public:
|
---|
61 | cmbAC() {
|
---|
62 | weight = 0.0;
|
---|
63 | numObs['G'] = 0;
|
---|
64 | numObs['R'] = 0;
|
---|
65 | numObs['E'] = 0;
|
---|
66 | numObs['C'] = 0;
|
---|
67 | numObs['J'] = 0;
|
---|
68 | numObs['S'] = 0;
|
---|
69 | numObs['I'] = 0;
|
---|
70 | }
|
---|
71 | ~cmbAC() {}
|
---|
72 | QString mountPoint;
|
---|
73 | QString name;
|
---|
74 | double weight;
|
---|
75 | QMap<char, unsigned> numObs;
|
---|
76 | };
|
---|
77 |
|
---|
78 | class cmbCorr {
|
---|
79 | public:
|
---|
80 | cmbCorr() {
|
---|
81 | _eph = 0;
|
---|
82 | _iod = 0;
|
---|
83 | _dClkResult = 0.0;
|
---|
84 | _codeBiasIF = 0.0;
|
---|
85 | }
|
---|
86 | ~cmbCorr() {}
|
---|
87 | QString _prn;
|
---|
88 | bncTime _time;
|
---|
89 | unsigned long _iod;
|
---|
90 | t_eph* _eph;
|
---|
91 | t_orbCorr _orbCorr;
|
---|
92 | t_clkCorr _clkCorr;
|
---|
93 | t_satCodeBias _satCodeBias;
|
---|
94 | QString _acName;
|
---|
95 | double _codeBiasIF;
|
---|
96 | double _dClkResult;
|
---|
97 | ColumnVector _diffRao;
|
---|
98 | QString ID() {return _acName + "_" + _prn;}
|
---|
99 | };
|
---|
100 |
|
---|
101 | class cmbEpoch {
|
---|
102 | public:
|
---|
103 | cmbEpoch() {}
|
---|
104 | ~cmbEpoch() {
|
---|
105 | QVectorIterator<cmbCorr*> it(corrs);
|
---|
106 | while (it.hasNext()) {
|
---|
107 | delete it.next();
|
---|
108 | }
|
---|
109 | }
|
---|
110 | QVector<cmbCorr*> corrs;
|
---|
111 | };
|
---|
112 |
|
---|
113 | class t_lcRefSig {
|
---|
114 | public:
|
---|
115 | enum type {dummy = 0, c1, c2, cIF};
|
---|
116 |
|
---|
117 | static t_frequency::type toFreq(char sys, type tt) {
|
---|
118 | switch (tt) {
|
---|
119 | case c1:
|
---|
120 | if (sys == 'G') return t_frequency::G1;
|
---|
121 | else if (sys == 'R') return t_frequency::R1;
|
---|
122 | else if (sys == 'E') return t_frequency::E1;
|
---|
123 | else if (sys == 'C') return t_frequency::C2;
|
---|
124 | else if (sys == 'J') return t_frequency::J1;
|
---|
125 | else if (sys == 'S') return t_frequency::S1;
|
---|
126 | else return t_frequency::dummy;
|
---|
127 | case c2:
|
---|
128 | if (sys == 'G') return t_frequency::G2;
|
---|
129 | else if (sys == 'R') return t_frequency::R2;
|
---|
130 | else if (sys == 'E') return t_frequency::E5;
|
---|
131 | else if (sys == 'C') return t_frequency::C6;
|
---|
132 | else if (sys == 'J') return t_frequency::J2;
|
---|
133 | else if (sys == 'S') return t_frequency::S5;
|
---|
134 | else return t_frequency::dummy;
|
---|
135 | case dummy:
|
---|
136 | case cIF:
|
---|
137 | return t_frequency::dummy;
|
---|
138 | }
|
---|
139 | return t_frequency::dummy;
|
---|
140 | }
|
---|
141 |
|
---|
142 | static char toAttrib(char sys, type LC) {
|
---|
143 | switch (LC) {
|
---|
144 | case c1:
|
---|
145 | if (sys == 'G') return 'W';
|
---|
146 | else if (sys == 'R') return 'P';
|
---|
147 | else if (sys == 'E') return 'C';
|
---|
148 | else if (sys == 'C') return 'I';
|
---|
149 | else if (sys == 'J') return 'C';
|
---|
150 | else if (sys == 'S') return 'C';
|
---|
151 | break;
|
---|
152 | case c2:
|
---|
153 | if (sys == 'G') return 'W';
|
---|
154 | else if (sys == 'R') return 'P';
|
---|
155 | else if (sys == 'E') return 'Q';
|
---|
156 | else if (sys == 'C') return 'I';
|
---|
157 | else if (sys == 'J') return 'L';
|
---|
158 | else if (sys == 'S') return 'Q';
|
---|
159 | break;
|
---|
160 | case dummy:
|
---|
161 | case cIF:
|
---|
162 | return '_';
|
---|
163 | break;
|
---|
164 | }
|
---|
165 | return '_';
|
---|
166 | }
|
---|
167 |
|
---|
168 | static void coeff(char sys, type tLC, double channel, std::map<t_frequency::type, double>& codeCoeff) {
|
---|
169 | codeCoeff.clear();
|
---|
170 | t_frequency::type fType1 = toFreq(sys, c1);
|
---|
171 | t_frequency::type fType2 = toFreq(sys, c2);
|
---|
172 | double f1 = t_CST::freq(fType1, channel);
|
---|
173 | double f2 = t_CST::freq(fType2, channel);
|
---|
174 | switch (tLC) {
|
---|
175 | case c1:
|
---|
176 | codeCoeff[fType1] = 1.0;
|
---|
177 | return;
|
---|
178 | case c2:
|
---|
179 | codeCoeff[fType2] = 1.0;
|
---|
180 | return;
|
---|
181 | case cIF:
|
---|
182 | codeCoeff[fType1] = f1 * f1 / (f1 * f1 - f2 * f2);
|
---|
183 | codeCoeff[fType2] = -f2 * f2 / (f1 * f1 - f2 * f2);
|
---|
184 | return;
|
---|
185 | case t_lcRefSig::dummy:
|
---|
186 | return;
|
---|
187 | }
|
---|
188 | return;
|
---|
189 | }
|
---|
190 | };
|
---|
191 |
|
---|
192 |
|
---|
193 | void processEpoch(char sys);
|
---|
194 | t_irc processEpoch_filter(char sys, QTextStream& out, QMap<QString, cmbCorr*>& resCorr,
|
---|
195 | ColumnVector& dx);
|
---|
196 | t_irc processEpoch_singleEpoch(char sys, QTextStream& out, QMap<QString, cmbCorr*>& resCorr,
|
---|
197 | ColumnVector& dx);
|
---|
198 | t_irc createAmat(char sys, Matrix& AA, ColumnVector& ll, DiagonalMatrix& PP,
|
---|
199 | const ColumnVector& x0, QMap<QString, cmbCorr*>& resCorr);
|
---|
200 | void dumpResults(const QMap<QString, cmbCorr*>& resCorr);
|
---|
201 | void printResults(QTextStream& out, const QMap<QString, cmbCorr*>& resCorr);
|
---|
202 | void switchToLastEph(t_eph* lastEph, cmbCorr* corr);
|
---|
203 | t_irc checkOrbits(char sys, QTextStream& out);
|
---|
204 | QVector<cmbCorr*>& corrs(char sys) {return _buffer[sys][_resTime].corrs;}
|
---|
205 |
|
---|
206 | QMutex _mutex;
|
---|
207 | QList<cmbAC*> _ACs;
|
---|
208 | bncTime _resTime;
|
---|
209 | QMap<char, QVector<cmbParam*>> _params;
|
---|
210 | QMap<char, QMap<bncTime, cmbEpoch>> _buffer;
|
---|
211 | bncRtnetDecoder* _rtnetDecoder;
|
---|
212 | QMap<char, SymmetricMatrix> _QQ;
|
---|
213 | QByteArray _log;
|
---|
214 | bncAntex* _antex;
|
---|
215 | double _MAXRES;
|
---|
216 | QMap<char, QString> _masterOrbitAC;
|
---|
217 | QMap<char, unsigned> _masterMissingEpochs;
|
---|
218 | e_method _method;
|
---|
219 | int _cmbSampl;
|
---|
220 | QString _cmbRefAttributes;
|
---|
221 | QMap<QString, QMap<t_prn, t_orbCorr> > _orbCorrections;
|
---|
222 | QMap<QString, QMap<t_prn, t_satCodeBias> > _satCodeBiases;
|
---|
223 | bncEphUser _ephUser;
|
---|
224 | SsrCorr* _ssrCorr;
|
---|
225 | QMap<char, unsigned> _cmbSysPrn;
|
---|
226 | bool _useGps;
|
---|
227 | bool _useGlo;
|
---|
228 | bool _useGal;
|
---|
229 | bool _useBds;
|
---|
230 | bool _useQzss;
|
---|
231 | bool _useSbas;
|
---|
232 | bool _useIrnss;
|
---|
233 | };
|
---|
234 |
|
---|
235 | #define BNC_CMB (bncComb::instance())
|
---|
236 |
|
---|
237 | #endif
|
---|