Index: trunk/BNC/src/RTCM3/RTCM3coDecoder.cpp =================================================================== --- trunk/BNC/src/RTCM3/RTCM3coDecoder.cpp (revision 10753) +++ trunk/BNC/src/RTCM3/RTCM3coDecoder.cpp (revision 10754) @@ -700,4 +700,5 @@ // =========// case RTCMssr: + case RTCMnewssr: if (coSat.Clock.DeltaA0 < -209.7151 || coSat.Clock.DeltaA0 > +209.7151) { Index: trunk/BNC/src/RTCM3/RTCM3coDecoder.h =================================================================== --- trunk/BNC/src/RTCM3/RTCM3coDecoder.h (revision 10753) +++ trunk/BNC/src/RTCM3/RTCM3coDecoder.h (revision 10754) @@ -33,4 +33,5 @@ #include "../RTCM3/clock_and_orbit/clock_orbit_igs.h" #include "../RTCM3/clock_and_orbit/clock_orbit_rtcm.h" +#include "../RTCM3/clock_and_orbit/clock_orbit_rtcm_new.h" #include "ephemeris.h" @@ -38,5 +39,5 @@ Q_OBJECT public: - enum e_type {RTCMssr, IGSssr}; + enum e_type {RTCMssr, IGSssr, RTCMnewssr}; RTCM3coDecoder(const QString& staID); virtual ~RTCM3coDecoder(); @@ -48,6 +49,9 @@ _ssrCorr = new SsrCorrRtcm(); } - else { + else if (_type == IGSssr) { _ssrCorr = new SsrCorrIgs(); + } + else if (_type == RTCMnewssr) { + _ssrCorr = new SsrCorrRtcmNew(); } } Index: trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit.cpp =================================================================== --- trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit.cpp (revision 10754) +++ trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit.cpp (revision 10754) @@ -0,0 +1,14 @@ +/* Programheader + + Name: clock_orbit.cpp + Project: RTCM3 + Version: $Id: clock_orbit.cpp 8996 2020-07-22 08:29:10Z stuerze $ + Authors: Andrea Stürze + Description: state space approach + */ + + +#include "clock_orbit.h" + +SsrCorr::SsrCorr() {} +SsrCorr::~SsrCorr() {} Index: trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit.h =================================================================== --- trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit.h (revision 10753) +++ trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit.h (revision 10754) @@ -94,6 +94,6 @@ public: - SsrCorr() {}; - virtual ~SsrCorr() {}; + SsrCorr(); + virtual ~SsrCorr(); virtual void setCorBase() = 0; virtual void setCorOffset() = 0; @@ -101,4 +101,5 @@ virtual void setCbType() = 0; virtual void setPbType() = 0; + virtual void setPbExtType() = 0; virtual void setVtecType() = 0; virtual void setCodeType() = 0; @@ -184,4 +185,13 @@ PhaseBiasType PBTYPE_BDS; PhaseBiasType PBTYPE_AUTO; + + typedef unsigned int PhaseBiasExtType; + PhaseBiasExtType PBEXTTYPE_BASE; + PhaseBiasExtType PBEXTTYPE_GPS; + PhaseBiasExtType PBEXTTYPE_GLONASS; + PhaseBiasExtType PBEXTTYPE_GALILEO; + PhaseBiasExtType PBEXTTYPE_QZSS; + PhaseBiasExtType PBEXTTYPE_BDS; + PhaseBiasExtType PBEXTTYPE_AUTO; typedef unsigned int VtecType; Index: trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_igs.cpp =================================================================== --- trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_igs.cpp (revision 10753) +++ trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_igs.cpp (revision 10754) @@ -16,6 +16,26 @@ #include #endif -#include - +#include "clock_orbit_igs.h" + +SsrCorrIgs::SsrCorrIgs() { + setCorBase(); + setCorOffset(); + setCoType(); + setCbType(); + setPbType(); + setPbExtType(); + setVtecType(); + setCodeType(); + + satoffset << CLOCKORBIT_OFFSETGPS + << CLOCKORBIT_OFFSETGLONASS + << CLOCKORBIT_OFFSETGALILEO + << CLOCKORBIT_OFFSETQZSS + << CLOCKORBIT_OFFSETSBAS + << CLOCKORBIT_OFFSETBDS + << CLOCKORBIT_COUNTSAT; +}; + +SsrCorrIgs::~SsrCorrIgs() {}; size_t SsrCorrIgs::MakeClockOrbit(const struct ClockOrbit *co, ClockOrbitType type, Index: trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_igs.h =================================================================== --- trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_igs.h (revision 10753) +++ trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_igs.h (revision 10754) @@ -10,31 +10,13 @@ Description: state space approach: IGS */ -#include + #include #include "clock_orbit.h" class SsrCorrIgs: public SsrCorr { - //Q_OBJECT public: - SsrCorrIgs() { - setCorBase(); - setCorOffset(); - setCoType(); - setCbType(); - setPbType(); - setVtecType(); - setCodeType(); - - satoffset << CLOCKORBIT_OFFSETGPS - << CLOCKORBIT_OFFSETGLONASS - << CLOCKORBIT_OFFSETGALILEO - << CLOCKORBIT_OFFSETQZSS - << CLOCKORBIT_OFFSETSBAS - << CLOCKORBIT_OFFSETBDS - << CLOCKORBIT_COUNTSAT; - }; - - ~SsrCorrIgs() {}; + SsrCorrIgs(); + ~SsrCorrIgs(); void setCorBase() { @@ -125,4 +107,6 @@ PBTYPE_AUTO = 0; }; + + void setPbExtType() { }; void setVtecType() { @@ -248,5 +232,5 @@ struct VTEC *v, struct PhaseBias *pb, const char *buffer, size_t size, int *bytesused); - }; +}; #endif /* RTCM3_CLOCK_ORBIT_IGS_H */ Index: trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm.cpp =================================================================== --- trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm.cpp (revision 10753) +++ trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm.cpp (revision 10754) @@ -18,4 +18,24 @@ #include "clock_orbit_rtcm.h" + SsrCorrRtcm::SsrCorrRtcm() { + setCorBase(); + setCorOffset(); + setCoType(); + setCbType(); + setPbType(); + setPbExtType(); + setVtecType(); + setCodeType(); + + satoffset << CLOCKORBIT_OFFSETGPS + << CLOCKORBIT_OFFSETGLONASS + << CLOCKORBIT_OFFSETGALILEO + << CLOCKORBIT_OFFSETQZSS + << CLOCKORBIT_OFFSETSBAS + << CLOCKORBIT_OFFSETBDS + << CLOCKORBIT_COUNTSAT; + }; + + SsrCorrRtcm::~SsrCorrRtcm() {}; size_t SsrCorrRtcm::MakeClockOrbit(const struct ClockOrbit *co, ClockOrbitType type, Index: trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm.h =================================================================== --- trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm.h (revision 10753) +++ trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm.h (revision 10754) @@ -15,26 +15,8 @@ class SsrCorrRtcm: public SsrCorr { - //Q_OBJECT public: - SsrCorrRtcm() { - setCorBase(); - setCorOffset(); - setCoType(); - setCbType(); - setPbType(); - setVtecType(); - setCodeType(); - - satoffset << CLOCKORBIT_OFFSETGPS - << CLOCKORBIT_OFFSETGLONASS - << CLOCKORBIT_OFFSETGALILEO - << CLOCKORBIT_OFFSETQZSS - << CLOCKORBIT_OFFSETSBAS - << CLOCKORBIT_OFFSETBDS - << CLOCKORBIT_COUNTSAT; - }; - - ~SsrCorrRtcm() {}; + SsrCorrRtcm(); + ~SsrCorrRtcm(); void setCorBase() { @@ -124,4 +106,6 @@ PBTYPE_AUTO = 0; }; + + void setPbExtType() {}; void setVtecType() { Index: trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm_new.cpp =================================================================== --- trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm_new.cpp (revision 10754) +++ trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm_new.cpp (revision 10754) @@ -0,0 +1,1373 @@ +/* Programheader + + Name: clock_orbit_rtcm_new.c + Project: RTCM3 + Version: $Id: clock_orbit_rtcm_new.c 8996 2020-07-22 08:29:10Z stuerze $ + Authors: Dirk Stöcker + Description: state space approach: RTCM_NEW + */ + +#include +#include +#include +#ifndef sparc +#include +#else +#include +#endif +#include "clock_orbit_rtcm_new.h" + +SsrCorrRtcmNew::SsrCorrRtcmNew() { + setCorBase(); + setCorOffset(); + setCoType(); + setCbType(); + setPbType(); + setPbExtType(); + setVtecType(); + setCodeType(); + + satoffset << CLOCKORBIT_OFFSETGPS + << CLOCKORBIT_OFFSETGLONASS + << CLOCKORBIT_OFFSETGALILEO + << CLOCKORBIT_OFFSETQZSS + << CLOCKORBIT_OFFSETSBAS + << CLOCKORBIT_OFFSETBDS + << CLOCKORBIT_COUNTSAT; +} +SsrCorrRtcmNew::~SsrCorrRtcmNew() {}; + +size_t SsrCorrRtcmNew::MakeClockOrbit(const struct ClockOrbit *co, ClockOrbitType type, + int moremessagesfollow, char *buffer, size_t size) { + std::vector< std::vector > status(CLOCKORBIT_SATNUM, std::vector(COBOFS_NUM)); + unsigned int i, s; + + //memset(status, 0, sizeof(status)); + + STARTDATA + + for (s = 0; s < CLOCKORBIT_SATNUM; ++s) { + for (i = 0; i < COBOFS_NUM; ++i) { + if (co->NumberOfSat[s] && (type == COTYPE_AUTO || type == corbase[s] + i) && + (co->Supplied[i] || (i <= COBOFS_CLOCK && co->Supplied[COBOFS_COMBINED]) || + (i == COBOFS_COMBINED && co->Supplied[COBOFS_ORBIT] && co->Supplied[COBOFS_CLOCK]))) { + status[s][i] = 1; + if (i == COBOFS_COMBINED) { + status[s][COBOFS_ORBIT] = status[s][COBOFS_CLOCK] = 0; + } /* disable single blocks for combined type */ + } /* check for data */ + } /* iterate over RTCM data types */ + } /* iterate over satellite systems */ + + for (s = 0; s < CLOCKORBIT_SATNUM; ++s) { + if (status[s][COBOFS_ORBIT]) { + INITBLOCK + T_RTCM_MESSAGE_NUMBER(corbase[s] + COBOFS_ORBIT) + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_SSR_EPOCH_TIME(co->EpochTime[s]) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_EPOCH_TIME(co->EpochTime[s]) + break; + } + T_SSR_UPDATE_INTERVAL(co->UpdateInterval) + T_MULTIPLE_MESSAGE_INDICATOR(moremessagesfollow ? 1 : 0) + T_SATELLITE_REFERENCE_DATUM(co->SatRefDatum) + T_SSR_IOD(co->SSRIOD) + T_SSR_PROVIDER_ID(co->SSRProviderID) + T_SSR_SOLUTION_ID(co->SSRSolutionID) + T_NO_OF_SATELLITES(co->NumberOfSat[s]) + for (i = satoffset[s]; i < satoffset[s] + co->NumberOfSat[s]; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + T_GPS_IODE(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_SATELLITE_ID(co->Sat[i].ID) + T_GLONASS_IOD(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATGALILEO: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + T_GALILEO_IOD(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATQZSS: + T_QZSS_SATELLITE_ID(co->Sat[i].ID) + T_GPS_IODE(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATSBAS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + T_SBAS_T0MOD(co->Sat[i].toe) + T_SBAS_IODCRC(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATBDS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + T_BDS_TOEMOD(co->Sat[i].toe) + T_BDS_IOD(co->Sat[i].IOD) + break; + } + T_DELTA_RADIAL(co->Sat[i].Orbit.DeltaRadial) + T_DELTA_ALONG_TRACK(co->Sat[i].Orbit.DeltaAlongTrack) + T_DELTA_CROSS_TRACK(co->Sat[i].Orbit.DeltaCrossTrack) + T_DELTA_DOT_RADIAL(co->Sat[i].Orbit.DotDeltaRadial) + T_DELTA_DOT_ALONG_TRACK(co->Sat[i].Orbit.DotDeltaAlongTrack) + T_DELTA_DOT_CROSS_TRACK(co->Sat[i].Orbit.DotDeltaCrossTrack) + } + ENDBLOCK + } + if (status[s][COBOFS_CLOCK]) { + INITBLOCK + T_RTCM_MESSAGE_NUMBER(corbase[s] + COBOFS_CLOCK) + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_SSR_EPOCH_TIME(co->EpochTime[s]) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_EPOCH_TIME(co->EpochTime[s]) + break; + } + T_SSR_UPDATE_INTERVAL(co->UpdateInterval) + T_MULTIPLE_MESSAGE_INDICATOR(moremessagesfollow ? 1 : 0) + T_SSR_IOD(co->SSRIOD) + T_SSR_PROVIDER_ID(co->SSRProviderID) + T_SSR_SOLUTION_ID(co->SSRSolutionID) + T_NO_OF_SATELLITES(co->NumberOfSat[s]) + for (i = satoffset[s]; i < satoffset[s] + co->NumberOfSat[s]; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + break; + case CLOCKORBIT_SATQZSS: + T_QZSS_SATELLITE_ID(co->Sat[i].ID) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_SATELLITE_ID(co->Sat[i].ID) + break; + } + T_DELTA_CLOCK_C0(co->Sat[i].Clock.DeltaA0) + T_DELTA_CLOCK_C1(co->Sat[i].Clock.DeltaA1) + T_DELTA_CLOCK_C2(co->Sat[i].Clock.DeltaA2) + } + ENDBLOCK + } + if (status[s][COBOFS_COMBINED]) { +#ifdef SPLITBLOCK + int nums = co->NumberOfSat[s]; + int left, start = satoffset[s]; + if(nums > 28) {/* split block when more than 28 sats */ + left = nums - 28; + nums = 28; + } + else { + left = 0; + } + while(nums) { +#endif + INITBLOCK + T_RTCM_MESSAGE_NUMBER(corbase[s] + COBOFS_COMBINED) + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_SSR_EPOCH_TIME(co->EpochTime[s]) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_EPOCH_TIME(co->EpochTime[s]) + break; + } + T_SSR_UPDATE_INTERVAL(co->UpdateInterval) +#ifdef SPLITBLOCK + T_MULTIPLE_MESSAGE_INDICATOR((moremessagesfollow || left) ? 1 : 0) +#else + T_MULTIPLE_MESSAGE_INDICATOR(moremessagesfollow ? 1 : 0) +#endif + T_SATELLITE_REFERENCE_DATUM(co->SatRefDatum) + T_SSR_IOD(co->SSRIOD) + T_SSR_PROVIDER_ID(co->SSRProviderID) + T_SSR_SOLUTION_ID(co->SSRSolutionID) +#ifdef SPLITBLOCK + T_NO_OF_SATELLITES(nums) + for(i = start; i < start+nums; ++i) +#else + T_NO_OF_SATELLITES(co->NumberOfSat[s]) + for (i = satoffset[s]; i < satoffset[s] + co->NumberOfSat[s]; ++i) +#endif + { + switch (s) { + case CLOCKORBIT_SATGPS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + T_GPS_IODE(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_SATELLITE_ID(co->Sat[i].ID) + T_GLONASS_IOD(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATGALILEO: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + T_GALILEO_IOD(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATQZSS: + T_QZSS_SATELLITE_ID(co->Sat[i].ID) + T_GPS_IODE(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATSBAS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + T_SBAS_T0MOD(co->Sat[i].toe) + T_SBAS_IODCRC(co->Sat[i].IOD) + break; + case CLOCKORBIT_SATBDS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + T_BDS_TOEMOD(co->Sat[i].toe) + T_BDS_IOD(co->Sat[i].IOD) + break; + } + T_DELTA_RADIAL(co->Sat[i].Orbit.DeltaRadial) + T_DELTA_ALONG_TRACK(co->Sat[i].Orbit.DeltaAlongTrack) + T_DELTA_CROSS_TRACK(co->Sat[i].Orbit.DeltaCrossTrack) + T_DELTA_DOT_RADIAL(co->Sat[i].Orbit.DotDeltaRadial) + T_DELTA_DOT_ALONG_TRACK(co->Sat[i].Orbit.DotDeltaAlongTrack) + T_DELTA_DOT_CROSS_TRACK(co->Sat[i].Orbit.DotDeltaCrossTrack) + T_DELTA_CLOCK_C0(co->Sat[i].Clock.DeltaA0) + T_DELTA_CLOCK_C1(co->Sat[i].Clock.DeltaA1) + T_DELTA_CLOCK_C2(co->Sat[i].Clock.DeltaA2) + } + ENDBLOCK +#ifdef SPLITBLOCK + start += nums; + nums = left; + left = 0; + } +#endif + } + if (status[s][COBOFS_HR]) { + INITBLOCK + T_RTCM_MESSAGE_NUMBER(corbase[s] + COBOFS_HR) + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_SSR_EPOCH_TIME(co->EpochTime[s]) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_EPOCH_TIME(co->EpochTime[s]) + break; + } + T_SSR_UPDATE_INTERVAL(co->UpdateInterval) + T_MULTIPLE_MESSAGE_INDICATOR(moremessagesfollow ? 1 : 0) + T_SSR_IOD(co->SSRIOD) + T_SSR_PROVIDER_ID(co->SSRProviderID) + T_SSR_SOLUTION_ID(co->SSRSolutionID) + T_NO_OF_SATELLITES(co->NumberOfSat[s]) + for (i = satoffset[s]; i < satoffset[s] + co->NumberOfSat[s]; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + break; + case CLOCKORBIT_SATQZSS: + T_QZSS_SATELLITE_ID(co->Sat[i].ID) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_SATELLITE_ID(co->Sat[i].ID) + break; + } + T_HR_CLOCK_CORRECTION(co->Sat[i].hrclock) + } + ENDBLOCK + } + if (status[s][COBOFS_URA]) { + INITBLOCK + T_RTCM_MESSAGE_NUMBER(corbase[s] + COBOFS_URA) + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_SSR_EPOCH_TIME(co->EpochTime[s]) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_EPOCH_TIME(co->EpochTime[s]) + break; + } + T_SSR_UPDATE_INTERVAL(co->UpdateInterval) + T_MULTIPLE_MESSAGE_INDICATOR(moremessagesfollow ? 1 : 0) + T_SSR_IOD(co->SSRIOD) + T_SSR_PROVIDER_ID(co->SSRProviderID) + T_SSR_SOLUTION_ID(co->SSRSolutionID) + T_NO_OF_SATELLITES(co->NumberOfSat[s]) + for (i = satoffset[s]; i < satoffset[s] + co->NumberOfSat[s]; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_GPS_SATELLITE_ID(co->Sat[i].ID) + break; + case CLOCKORBIT_SATQZSS: + T_QZSS_SATELLITE_ID(co->Sat[i].ID) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_SATELLITE_ID(co->Sat[i].ID) + break; + } + T_SSR_URA(ValueToURA(co->Sat[i].UserRangeAccuracy)) + } + ENDBLOCK + } + } + return ressize; +} + +size_t SsrCorrRtcmNew::MakeCodeBias(const struct CodeBias *b, CodeBiasType type, + int moremessagesfollow, char *buffer, size_t size) { + unsigned int s, i, j; + + STARTDATA + + for (s = 0; s < CLOCKORBIT_SATNUM; ++s) { + if (b->NumberOfSat[s] && (type == CBTYPE_AUTO || type == corbase[s] + COBOFS_CBIAS)) { + INITBLOCK + T_RTCM_MESSAGE_NUMBER(corbase[s] + COBOFS_CBIAS) + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_SSR_EPOCH_TIME(b->EpochTime[s]) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_EPOCH_TIME(b->EpochTime[s]) + break; + } + T_SSR_UPDATE_INTERVAL(b->UpdateInterval) + T_MULTIPLE_MESSAGE_INDICATOR(moremessagesfollow ? 1 : 0) + T_SSR_IOD(b->SSRIOD) + T_SSR_PROVIDER_ID(b->SSRProviderID) + T_SSR_SOLUTION_ID(b->SSRSolutionID) + T_NO_OF_SATELLITES(b->NumberOfSat[s]) + for (i = satoffset[s]; i < satoffset[s] + b->NumberOfSat[s]; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_GPS_SATELLITE_ID(b->Sat[i].ID) + break; + case CLOCKORBIT_SATQZSS: + T_QZSS_SATELLITE_ID(b->Sat[i].ID) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_SATELLITE_ID(b->Sat[i].ID) + break; + } + T_NO_OF_BIASES(b->Sat[i].NumberOfCodeBiases) + for (j = 0; j < b->Sat[i].NumberOfCodeBiases; ++j) { + T_GNSS_SIGNAL_IDENTIFIER(b->Sat[i].Biases[j].Type) + T_CODE_BIAS(b->Sat[i].Biases[j].Bias) + } + } + ENDBLOCK + } + } + return ressize; +} + +size_t SsrCorrRtcmNew::MakePhaseBias(const struct PhaseBias *b, PhaseBiasType type, + int moremessagesfollow, char *buffer, size_t size) { + unsigned int s, i, j; + + STARTDATA + + for (s = 0; s < CLOCKORBIT_SATNUM; ++s) { + if (b->NumberOfSat[s] && (type == PBTYPE_AUTO || type == s + PBTYPE_BASE)) { + INITBLOCK + T_RTCM_MESSAGE_NUMBER(s + PBTYPE_BASE) + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_SSR_EPOCH_TIME(b->EpochTime[s]) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_EPOCH_TIME(b->EpochTime[s]) + break; + } + T_SSR_UPDATE_INTERVAL(b->UpdateInterval) + T_MULTIPLE_MESSAGE_INDICATOR(moremessagesfollow ? 1 : 0) + T_SSR_IOD(b->SSRIOD) + T_SSR_PROVIDER_ID(b->SSRProviderID) + T_SSR_SOLUTION_ID(b->SSRSolutionID) + T_DISPERSIVE_BIAS_INDICATOR(b->DispersiveBiasConsistencyIndicator ? 1 : 0) + T_MW_CONSISTENCY_INDICATOR(b->MWConsistencyIndicator ? 1 : 0) + T_NO_OF_SATELLITES(b->NumberOfSat[s]) + for (i = satoffset[s]; i < satoffset[s] + b->NumberOfSat[s]; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + T_GPS_SATELLITE_ID(b->Sat[i].ID) + break; + case CLOCKORBIT_SATQZSS: + T_QZSS_SATELLITE_ID(b->Sat[i].ID) + break; + case CLOCKORBIT_SATGLONASS: + T_GLONASS_SATELLITE_ID(b->Sat[i].ID) + break; + } + T_NO_OF_BIASES(b->Sat[i].NumberOfPhaseBiases) + T_YAW_ANGLE(b->Sat[i].YawAngle) + T_YAW_RATE(b->Sat[i].YawRate) + for (j = 0; j < b->Sat[i].NumberOfPhaseBiases; ++j) { + T_GNSS_SIGNAL_IDENTIFIER(b->Sat[i].Biases[j].Type) + T_INTEGER_INDICATOR( + b->Sat[i].Biases[j].SignalIntegerIndicator ? 1 : 0) + T_WIDE_LANE_INDICATOR( + b->Sat[i].Biases[j].SignalsWideLaneIntegerIndicator) + T_DISCONTINUITY_COUNTER( + b->Sat[i].Biases[j].SignalDiscontinuityCounter) + T_PHASE_BIAS(b->Sat[i].Biases[j].Bias) + } + } + ENDBLOCK + } + } + return ressize; +} + +size_t SsrCorrRtcmNew::MakeVTEC(const struct VTEC *v, int moremessagesfollow, char *buffer, size_t size) { + unsigned int l, o, d; + + STARTDATA + INITBLOCK + T_RTCM_MESSAGE_NUMBER(VTEC_BASE) + T_SSR_EPOCH_TIME(v->EpochTime) + T_SSR_UPDATE_INTERVAL(v->UpdateInterval) + T_MULTIPLE_MESSAGE_INDICATOR(moremessagesfollow ? 1 : 0) + T_SSR_IOD(v->SSRIOD) + T_SSR_PROVIDER_ID(v->SSRProviderID) + T_SSR_SOLUTION_ID(v->SSRSolutionID) + T_VTEC_QUALITY_INDICATOR(v->Quality) + T_NO_IONO_LAYERS(v->NumLayers) + for (l = 0; l < v->NumLayers; ++l) { + T_IONO_HEIGHT(v->Layers[l].Height) + T_IONO_DEGREE(v->Layers[l].Degree) + T_IONO_ORDER(v->Layers[l].Order) + for (o = 0; o <= v->Layers[l].Order; ++o) { + for (d = o; d <= v->Layers[l].Degree; ++d) { + T_IONO_COEFF_C(v->Layers[l].Cosinus[d][o]) + } + } + for (o = 1; o <= v->Layers[l].Order; ++o) { + for (d = o; d <= v->Layers[l].Degree; ++d) { + T_IONO_COEFF_S(v->Layers[l].Sinus[d][o]) + } + } + } + ENDBLOCK + return ressize; +} + +enum GCOB_RETURN SsrCorrRtcmNew::GetSSR(struct ClockOrbit *co, struct CodeBias *b,struct VTEC *v, + struct PhaseBias *pb, const char *buffer, size_t size, int *bytesused) { + int mmi = 0, h, rs; + unsigned int type, pos, i, j, s, nums, id; + size_t sizeofrtcmblock; + const char *blockstart = buffer; + DECODESTART + + if (size < 7) + return GCOBR_SHORTBUFFER; + +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "GetSSR-RTCM START: size %d, numbits %d\n",(int)size, numbits); +#endif + + G_HEADER(h) + G_RESERVEDH(rs) + G_SIZE(sizeofrtcmblock); + + if ((unsigned char) h != 0xD3 || rs) + return GCOBR_UNKNOWNDATA; + if (size < sizeofrtcmblock + 3) /* 3 header bytes already removed */ + return GCOBR_MESSAGEEXCEEDSBUFFER; + if (CRC24(sizeofrtcmblock + 3, (const unsigned char *) blockstart) != + (uint32_t) ((((unsigned char) buffer[sizeofrtcmblock]) << 16) | + (((unsigned char) buffer[sizeofrtcmblock + 1]) << 8) | + (((unsigned char) buffer[sizeofrtcmblock + 2])))) + return GCOBR_CRCMISMATCH; + size = sizeofrtcmblock; /* reduce size, so overflows are detected */ + + G_RTCM_MESSAGE_NUMBER(type) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "type %d size %d\n",type,(int)sizeofrtcmblock); +#endif + if (bytesused) + *bytesused = sizeofrtcmblock + 6; + if (type == VTEC_BASE) { + unsigned int l, o, d; + if (!v) + return GCOBR_NOVTECPARAMETER; + memset(v, 0, sizeof(*v)); + G_SSR_EPOCH_TIME(v->EpochTime) + G_SSR_UPDATE_INTERVAL(v->UpdateInterval) + G_MULTIPLE_MESSAGE_INDICATOR(mmi) + G_SSR_IOD(v->SSRIOD) + G_SSR_PROVIDER_ID(v->SSRProviderID) + G_SSR_SOLUTION_ID(v->SSRSolutionID) + G_VTEC_QUALITY_INDICATOR(v->Quality) + G_NO_IONO_LAYERS(v->NumLayers) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "epochTime %d ui %d mmi %d ssrIod %d providerId %d solId %d vtecQ %8.3f numLay %d \n", + v->EpochTime, v->UpdateInterval, mmi, + v->SSRIOD, v->SSRProviderID, v->SSRSolutionID, v->Quality, v->NumLayers); +#endif + for (l = 0; l < v->NumLayers; ++l) { + G_IONO_HEIGHT(v->Layers[l].Height) + G_IONO_DEGREE(v->Layers[l].Degree) + G_IONO_ORDER(v->Layers[l].Order) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "h %8.3f deg %d ord %d \n", + v->Layers[l].Height, v->Layers[l].Degree, v->Layers[l].Order); +#endif + for (o = 0; o <= v->Layers[l].Order; ++o) { + for (d = o; d <= v->Layers[l].Degree; ++d) { + G_IONO_COEFF_C(v->Layers[l].Cosinus[d][o]) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "C[%02d][%02d] %8.3f \n", + d, o, v->Layers[l].Cosinus[d][o]); +#endif + } + } + for (o = 1; o <= v->Layers[l].Order; ++o) { + for (d = o; d <= v->Layers[l].Degree; ++d) { + G_IONO_COEFF_S(v->Layers[l].Sinus[d][o]) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "S[%02d][%02d] %8.3f \n", + d, o, v->Layers[l].Sinus[d][o]); +#endif + } + } + } +#ifdef BNC_DEBUG_SSR + for(type = 0; type < (unsigned int)size && (unsigned char)buffer[type] != 0xD3; ++type) + numbits += 8; + fprintf(stderr, "numbits left %d\n",numbits); +#endif + return mmi ? GCOBR_MESSAGEFOLLOWS : GCOBR_OK; + } + for (s = CLOCKORBIT_SATNUM; s-- > 0;) { + if (type == PBTYPE_BASE + s) { + if (!pb) + return GCOBR_NOPHASEBIASPARAMETER; + pb->messageType = type; + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_SSR_EPOCH_TIME_CHECK(pb->EpochTime[s], pb->NumberOfSat[s]) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_EPOCH_TIME(pb->EpochTime[s], pb->NumberOfSat[s]) + break; + } + G_SSR_UPDATE_INTERVAL(pb->UpdateInterval) + G_MULTIPLE_MESSAGE_INDICATOR(mmi) + G_SSR_IOD(pb->SSRIOD) + G_SSR_PROVIDER_ID(pb->SSRProviderID) + G_SSR_SOLUTION_ID(pb->SSRSolutionID) + G_DISPERSIVE_BIAS_INDICATOR(pb->DispersiveBiasConsistencyIndicator) + G_MW_CONSISTENCY_INDICATOR(pb->MWConsistencyIndicator) + G_NO_OF_SATELLITES(nums) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d dispInd %d mwInd %d\n", + pb->EpochTime[s], pb->UpdateInterval,mmi,pb->NumberOfSat[s],nums, + pb->SSRIOD, pb->SSRProviderID, pb->SSRSolutionID, + pb->DispersiveBiasConsistencyIndicator, pb->MWConsistencyIndicator); +#endif + for (i = 0; i < nums; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_GNSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATQZSS: + G_QZSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_SATELLITE_ID(id) + break; + } + for (pos = satoffset[s]; + pos < satoffset[s] + pb->NumberOfSat[s] && pb->Sat[pos].ID != id; + ++pos) + ; + if (pos >= satoffset[s + 1]) + return GCOBR_DATAMISMATCH; + else if (pos == pb->NumberOfSat[s] + satoffset[s]) + ++pb->NumberOfSat[s]; + pb->Sat[pos].ID = id; + G_NO_OF_BIASES(pb->Sat[pos].NumberOfPhaseBiases) + G_YAW_ANGLE(pb->Sat[pos].YawAngle) + G_YAW_RATE(pb->Sat[pos].YawRate) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "id %2d #%d y %10.6f yr %10.6f ", + pb->Sat[pos].ID, pb->Sat[pos].NumberOfPhaseBiases, + pb->Sat[pos].YawAngle/MPI, pb->Sat[pos].YawRate/MPI); +#endif + for (j = 0; j < pb->Sat[pos].NumberOfPhaseBiases; ++j) { + G_GNSS_SIGNAL_IDENTIFIER(pb->Sat[pos].Biases[j].Type) + G_INTEGER_INDICATOR(pb->Sat[pos].Biases[j].SignalIntegerIndicator) + G_WIDE_LANE_INDICATOR( + pb->Sat[pos].Biases[j].SignalsWideLaneIntegerIndicator) + G_DISCONTINUITY_COUNTER( + pb->Sat[pos].Biases[j].SignalDiscontinuityCounter) + G_PHASE_BIAS(pb->Sat[pos].Biases[j].Bias) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "t%02d int %d wl %d disc %d b %8.4f ", + pb->Sat[pos].Biases[j].Type, + pb->Sat[pos].Biases[j].SignalIntegerIndicator, + pb->Sat[pos].Biases[j].SignalsWideLaneIntegerIndicator, + pb->Sat[pos].Biases[j].SignalDiscontinuityCounter, + pb->Sat[pos].Biases[j].Bias); +#endif + } +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "\n"); +#endif + } +#ifdef BNC_DEBUG_SSR + for(type = 0; type < (unsigned int)size && (unsigned char)buffer[type] != 0xD3; ++type) + numbits += 8; + fprintf(stderr, "numbits left %d\n",numbits); +#endif + return mmi ? GCOBR_MESSAGEFOLLOWS : GCOBR_OK; + } + else if (type >= corbase[s]) { + unsigned int corrOffset = type - corbase[s]; + if (corrOffset == COBOFS_ORBIT) { + if (!co) + return GCOBR_NOCLOCKORBITPARAMETER; + co->messageType = type; + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_SSR_EPOCH_TIME_CHECK(co->EpochTime[s], co->NumberOfSat[s]) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_EPOCH_TIME(co->EpochTime[s], co->NumberOfSat[s]) + break; + } + G_SSR_UPDATE_INTERVAL(co->UpdateInterval) + G_MULTIPLE_MESSAGE_INDICATOR(mmi) + G_SATELLITE_REFERENCE_DATUM(co->SatRefDatum) + G_SSR_IOD(co->SSRIOD) + G_SSR_PROVIDER_ID(co->SSRProviderID) + G_SSR_SOLUTION_ID(co->SSRSolutionID) + G_NO_OF_SATELLITES(nums) + co->Supplied[COBOFS_ORBIT] |= 1; +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d rd %d ssrIod %d providerId %d solId %d\n", + co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums, + co->SatRefDatum, co->SSRIOD, co->SSRProviderID, co->SSRSolutionID); +#endif + for (i = 0; i < nums; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_GNSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATQZSS: + G_QZSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_SATELLITE_ID(id) + break; + } + for (pos = satoffset[s]; + pos < satoffset[s] + co->NumberOfSat[s] && co->Sat[pos].ID != id; + ++pos) + ; + if (pos >= satoffset[s + 1]) + return GCOBR_DATAMISMATCH; + else if (pos == co->NumberOfSat[s] + satoffset[s]) + ++co->NumberOfSat[s]; + co->Sat[pos].ID = id; + + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATQZSS: + G_GNSS_IOD(co->Sat[pos].IOD) + break; + case CLOCKORBIT_SATGLONASS: + G_GNSS_IOD(co->Sat[pos].IOD) + break; + case CLOCKORBIT_SATGALILEO: + G_GALILEO_IOD(co->Sat[pos].IOD) + break; + case CLOCKORBIT_SATSBAS: + G_SBAS_T0MOD(co->Sat[pos].toe) + G_SBAS_IODCRC(co->Sat[pos].IOD) + break; + case CLOCKORBIT_SATBDS: + G_BDS_TOEMOD(co->Sat[pos].toe) + G_GNSS_IOD(co->Sat[pos].IOD) + break; + } + G_DELTA_RADIAL(co->Sat[pos].Orbit.DeltaRadial) + G_DELTA_ALONG_TRACK(co->Sat[pos].Orbit.DeltaAlongTrack) + G_DELTA_CROSS_TRACK(co->Sat[pos].Orbit.DeltaCrossTrack) + G_DELTA_DOT_RADIAL(co->Sat[pos].Orbit.DotDeltaRadial) + G_DELTA_DOT_ALONG_TRACK(co->Sat[pos].Orbit.DotDeltaAlongTrack) + G_DELTA_DOT_CROSS_TRACK(co->Sat[pos].Orbit.DotDeltaCrossTrack) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "id %2d iod %3d dr %8.4f da %8.4f dc %8.4f dr %8.3f da %8.3f dc %8.3f\n", + co->Sat[pos].ID,co->Sat[pos].IOD,co->Sat[pos].Orbit.DeltaRadial, + co->Sat[pos].Orbit.DeltaAlongTrack,co->Sat[pos].Orbit.DeltaCrossTrack, + co->Sat[pos].Orbit.DotDeltaRadial, + co->Sat[pos].Orbit.DotDeltaAlongTrack, + co->Sat[pos].Orbit.DotDeltaCrossTrack); +#endif + } + } + else if (corrOffset == COBOFS_CLOCK) { + if (!co) + return GCOBR_NOCLOCKORBITPARAMETER; + co->messageType = type; + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_SSR_EPOCH_TIME_CHECK(co->EpochTime[s], co->NumberOfSat[s]) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_EPOCH_TIME(co->EpochTime[s], co->NumberOfSat[s]) + break; + } + G_SSR_UPDATE_INTERVAL(co->UpdateInterval) + G_MULTIPLE_MESSAGE_INDICATOR(mmi) + G_SSR_IOD(co->SSRIOD) + G_SSR_PROVIDER_ID(co->SSRProviderID) + G_SSR_SOLUTION_ID(co->SSRSolutionID) + G_NO_OF_SATELLITES(nums) + co->Supplied[COBOFS_CLOCK] |= 1; +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d\n", + co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums, + co->SSRIOD, co->SSRProviderID, co->SSRSolutionID); +#endif + for (i = 0; i < nums; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_GNSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATQZSS: + G_QZSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_SATELLITE_ID(id) + break; + } + for (pos = satoffset[s]; + pos < satoffset[s] + co->NumberOfSat[s] && co->Sat[pos].ID != id; + ++pos) + ; + if (pos >= satoffset[s + 1]) + return GCOBR_DATAMISMATCH; + else if (pos == co->NumberOfSat[s] + satoffset[s]) + ++co->NumberOfSat[s]; + co->Sat[pos].ID = id; + + G_DELTA_CLOCK_C0(co->Sat[pos].Clock.DeltaA0) + G_DELTA_CLOCK_C1(co->Sat[pos].Clock.DeltaA1) + G_DELTA_CLOCK_C2(co->Sat[pos].Clock.DeltaA2) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "id %2d c0 %8.3f c1 %8.3f c2 %8.3f\n", + co->Sat[pos].ID, co->Sat[pos].Clock.DeltaA0, co->Sat[pos].Clock.DeltaA1, + co->Sat[pos].Clock.DeltaA2); +#endif + } + } + else if (corrOffset == COBOFS_COMBINED) { + if (!co) + return GCOBR_NOCLOCKORBITPARAMETER; + co->messageType = type; + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_SSR_EPOCH_TIME_CHECK(co->EpochTime[s], co->NumberOfSat[s]) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_EPOCH_TIME(co->EpochTime[s], co->NumberOfSat[s]) + break; + } + G_SSR_UPDATE_INTERVAL(co->UpdateInterval) + G_MULTIPLE_MESSAGE_INDICATOR(mmi) + G_SATELLITE_REFERENCE_DATUM(co->SatRefDatum) + G_SSR_IOD(co->SSRIOD) + G_SSR_PROVIDER_ID(co->SSRProviderID) + G_SSR_SOLUTION_ID(co->SSRSolutionID) + G_NO_OF_SATELLITES(nums) + co->Supplied[COBOFS_ORBIT] |= 1; + co->Supplied[COBOFS_CLOCK] |= 1; +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d rd %d ssrIod %d providerId %d solId %d\n", + co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums, + co->SatRefDatum, co->SSRIOD, co->SSRProviderID, co->SSRSolutionID); +#endif + for (i = 0; i < nums; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_GNSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATQZSS: + G_QZSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_SATELLITE_ID(id) + break; + } + for (pos = satoffset[s]; + pos < satoffset[s] + co->NumberOfSat[s] && co->Sat[pos].ID != id; + ++pos) + ; + if (pos >= satoffset[s + 1]) + return GCOBR_DATAMISMATCH; + else if (pos == co->NumberOfSat[s] + satoffset[s]) + ++co->NumberOfSat[s]; + co->Sat[pos].ID = id; + + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATQZSS: + G_GNSS_IOD(co->Sat[pos].IOD) + break; + case CLOCKORBIT_SATGLONASS: + G_GNSS_IOD(co->Sat[pos].IOD) + break; + case CLOCKORBIT_SATGALILEO: + G_GALILEO_IOD(co->Sat[pos].IOD) + break; + case CLOCKORBIT_SATSBAS: + G_SBAS_T0MOD(co->Sat[pos].toe) + G_SBAS_IODCRC(co->Sat[pos].IOD) + break; + case CLOCKORBIT_SATBDS: + G_BDS_TOEMOD(co->Sat[pos].toe) + G_GNSS_IOD(co->Sat[pos].IOD) + break; + } + G_DELTA_RADIAL(co->Sat[pos].Orbit.DeltaRadial) + G_DELTA_ALONG_TRACK(co->Sat[pos].Orbit.DeltaAlongTrack) + G_DELTA_CROSS_TRACK(co->Sat[pos].Orbit.DeltaCrossTrack) + G_DELTA_DOT_RADIAL(co->Sat[pos].Orbit.DotDeltaRadial) + G_DELTA_DOT_ALONG_TRACK(co->Sat[pos].Orbit.DotDeltaAlongTrack) + G_DELTA_DOT_CROSS_TRACK(co->Sat[pos].Orbit.DotDeltaCrossTrack) + G_DELTA_CLOCK_C0(co->Sat[pos].Clock.DeltaA0) + G_DELTA_CLOCK_C1(co->Sat[pos].Clock.DeltaA1) + G_DELTA_CLOCK_C2(co->Sat[pos].Clock.DeltaA2) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "id %2d iod %3d dr %10.6f da %10.6f dc %10.6f dr %10.6f da %10.6f dc %10.6f c0 %10.6f c1 %10.6f c2 %10.6f\n", + co->Sat[pos].ID,co->Sat[pos].IOD,co->Sat[pos].Orbit.DeltaRadial, + co->Sat[pos].Orbit.DeltaAlongTrack,co->Sat[pos].Orbit.DeltaCrossTrack, + co->Sat[pos].Orbit.DotDeltaRadial, co->Sat[pos].Orbit.DotDeltaAlongTrack, + co->Sat[pos].Orbit.DotDeltaCrossTrack, + co->Sat[pos].Clock.DeltaA0, co->Sat[pos].Clock.DeltaA1, co->Sat[pos].Clock.DeltaA2); +#endif + } + } + else if (corrOffset == COBOFS_URA) { + if (!co) + return GCOBR_NOCLOCKORBITPARAMETER; + co->messageType = type; + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_SSR_EPOCH_TIME_CHECK(co->EpochTime[s], co->NumberOfSat[s]) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_EPOCH_TIME(co->EpochTime[s], co->NumberOfSat[s]) + break; + } + G_SSR_UPDATE_INTERVAL(co->UpdateInterval) + G_MULTIPLE_MESSAGE_INDICATOR(mmi) + G_SSR_IOD(co->SSRIOD) + G_SSR_PROVIDER_ID(co->SSRProviderID) + G_SSR_SOLUTION_ID(co->SSRSolutionID) + G_NO_OF_SATELLITES(nums) + co->Supplied[COBOFS_URA] |= 1; +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d\n", + co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums, + co->SSRIOD, co->SSRProviderID, co->SSRSolutionID); +#endif + for (i = 0; i < nums; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_GNSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATQZSS: + G_QZSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_SATELLITE_ID(id) + break; + } + for (pos = satoffset[s]; + pos < satoffset[s] + co->NumberOfSat[s] && co->Sat[pos].ID != id; + ++pos) + ; + if (pos >= satoffset[s + 1]) + return GCOBR_DATAMISMATCH; + else if (pos == co->NumberOfSat[s] + satoffset[s]) + ++co->NumberOfSat[s]; + co->Sat[pos].ID = id; + G_SSR_URA(co->Sat[pos].UserRangeAccuracy) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "id %2d ura %8.3f \n", + co->Sat[pos].ID, co->Sat[pos].UserRangeAccuracy); +#endif + } + } + else if (corrOffset == COBOFS_HR) { + if (!co) + return GCOBR_NOCLOCKORBITPARAMETER; + co->messageType = type; + switch (s) { + case CLOCKORBIT_SATGPS:/* Phase specific part of GNSS phase bias message */ + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_SSR_EPOCH_TIME_CHECK(co->EpochTime[s], co->NumberOfSat[s]) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_EPOCH_TIME(co->EpochTime[s], co->NumberOfSat[s]) + break; + } + G_SSR_UPDATE_INTERVAL(co->UpdateInterval) + G_MULTIPLE_MESSAGE_INDICATOR(mmi) + G_SSR_IOD(co->SSRIOD) + G_SSR_PROVIDER_ID(co->SSRProviderID) + G_SSR_SOLUTION_ID(co->SSRSolutionID) + G_NO_OF_SATELLITES(nums) + co->Supplied[COBOFS_HR] |= 1; +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d\n", + co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums, + co->SSRIOD, co->SSRProviderID, co->SSRSolutionID); +#endif + for (i = 0; i < nums; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_GNSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATQZSS: + G_QZSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_SATELLITE_ID(id) + break; + } + for (pos = satoffset[s]; + pos < satoffset[s] + co->NumberOfSat[s] && co->Sat[pos].ID != id; + ++pos) + ; + if (pos >= satoffset[s + 1]) + return GCOBR_DATAMISMATCH; + else if (pos == co->NumberOfSat[s] + satoffset[s]) + ++co->NumberOfSat[s]; + co->Sat[pos].ID = id; + G_HR_CLOCK_CORRECTION(co->Sat[pos].hrclock) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "id %2d hrClock %8.3f \n", + co->Sat[pos].ID, co->Sat[pos].hrclock); +#endif + } + } + else if (corrOffset == COBOFS_CBIAS) { + if (!b) + return GCOBR_NOCODEBIASPARAMETER; + b->messageType = type; + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATQZSS: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_SSR_EPOCH_TIME_CHECK(b->EpochTime[s], b->NumberOfSat[s]) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_EPOCH_TIME(b->EpochTime[s], b->NumberOfSat[s]) + break; + } + G_SSR_UPDATE_INTERVAL(b->UpdateInterval) + G_MULTIPLE_MESSAGE_INDICATOR(mmi) + G_SSR_IOD(b->SSRIOD) + G_SSR_PROVIDER_ID(b->SSRProviderID) + G_SSR_SOLUTION_ID(b->SSRSolutionID) + G_NO_OF_SATELLITES(nums) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d\n", + b->EpochTime[s], b->UpdateInterval,mmi,b->NumberOfSat[s],nums, + b->SSRIOD, b->SSRProviderID, b->SSRSolutionID); +#endif + for (i = 0; i < nums; ++i) { + switch (s) { + case CLOCKORBIT_SATGPS: + case CLOCKORBIT_SATGALILEO: + case CLOCKORBIT_SATSBAS: + case CLOCKORBIT_SATBDS: + G_GNSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATQZSS: + G_QZSS_SATELLITE_ID(id) + break; + case CLOCKORBIT_SATGLONASS: + G_GLONASS_SATELLITE_ID(id) + break; + } + for (pos = satoffset[s]; + pos < satoffset[s] + b->NumberOfSat[s] && b->Sat[pos].ID != id; + ++pos) + ; + if (pos >= satoffset[s + 1]) + return GCOBR_DATAMISMATCH; + else if (pos == b->NumberOfSat[s] + satoffset[s]) + ++b->NumberOfSat[s]; + b->Sat[pos].ID = id; + G_NO_OF_BIASES(b->Sat[pos].NumberOfCodeBiases) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "id %2d #%d ", + b->Sat[pos].ID, b->Sat[pos].NumberOfCodeBiases); +#endif + for (j = 0; j < b->Sat[pos].NumberOfCodeBiases; ++j) { + G_GNSS_SIGNAL_IDENTIFIER(b->Sat[pos].Biases[j].Type) + G_CODE_BIAS(b->Sat[pos].Biases[j].Bias) +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "t%02d b %8.2f ", + b->Sat[pos].Biases[j].Type, b->Sat[pos].Biases[j].Bias); +#endif + } +#ifdef BNC_DEBUG_SSR + fprintf(stderr, "\n"); +#endif + } + } + else { + continue; + } +#ifdef BNC_DEBUG_SSR + for(type = 0; type < (unsigned int)size && (unsigned char)buffer[type] != 0xD3; ++type) + numbits += 8; + fprintf(stderr, "numbits left %d\n",numbits); +#endif + return mmi ? GCOBR_MESSAGEFOLLOWS : GCOBR_OK; + } + } + return GCOBR_UNKNOWNTYPE; +} + +// +//////////////////////////////////////////////////////////////////////////// +std::string SsrCorrRtcmNew::codeTypeToRnxType(char system, CodeType type) { + if (system == 'G') { + if (type == CODETYPE_GPS_L1_CA) return "1C"; + if (type == CODETYPE_GPS_L1_P) return "1P"; + if (type == CODETYPE_GPS_L1_Z) return "1W"; + + if (type == CODETYPE_GPS_SEMI_CODELESS) return "2D"; + if (type == CODETYPE_GPS_L2_CA) return "2C"; + if (type == CODETYPE_GPS_L2_P) return "2P"; + if (type == CODETYPE_GPS_L2_Z) return "2W"; + + if (type == CODETYPE_GPS_L2C_M) return "2S"; + if (type == CODETYPE_GPS_L2C_L) return "2L"; + if (type == CODETYPE_GPS_L2C_ML) return "2X"; + + if (type == CODETYPE_GPS_L5_I) return "5I"; + if (type == CODETYPE_GPS_L5_Q) return "5Q"; + if (type == CODETYPE_GPS_L5_IQ) return "5X"; + + if (type == CODETYPE_GPS_L1C_D) return "1S"; + if (type == CODETYPE_GPS_L1C_P) return "1L"; + if (type == CODETYPE_GPS_L1C_DP) return "1X"; + } + else if (system == 'R') { + if (type == CODETYPE_GLONASS_L1_CA) return "1C"; + if (type == CODETYPE_GLONASS_L1_P) return "1P"; + + if (type == CODETYPE_GLONASS_L2_CA) return "2C"; + if (type == CODETYPE_GLONASS_L2_P) return "2P"; + + if (type == CODETYPE_GLONASS_L1a_OCd) return "4A"; + if (type == CODETYPE_GLONASS_L1a_OCp) return "4B"; + if (type == CODETYPE_GLONASS_L1a_OCdp) return "4X"; + + if (type == CODETYPE_GLONASS_L2a_CSI) return "6A"; + if (type == CODETYPE_GLONASS_L2a_OCp) return "6B"; + if (type == CODETYPE_GLONASS_L2a_CSIOCp)return "6X"; + + if (type == CODETYPE_GLONASS_L3_I) return "3I"; + if (type == CODETYPE_GLONASS_L3_Q) return "3Q"; + if (type == CODETYPE_GLONASS_L3_IQ) return "3X"; + } + else if (system == 'E') { + if (type == CODETYPE_GALILEO_E1_A) return "1A"; + if (type == CODETYPE_GALILEO_E1_B) return "1B"; + if (type == CODETYPE_GALILEO_E1_C) return "1C"; + if (type == CODETYPE_GALILEO_E1_BC) return "1X"; + if (type == CODETYPE_GALILEO_E1_ABC) return "1Z"; + + if (type == CODETYPE_GALILEO_E5A_I) return "5I"; + if (type == CODETYPE_GALILEO_E5A_Q) return "5Q"; + if (type == CODETYPE_GALILEO_E5A_IQ) return "5X"; + + if (type == CODETYPE_GALILEO_E5B_I) return "7I"; + if (type == CODETYPE_GALILEO_E5B_Q) return "7Q"; + if (type == CODETYPE_GALILEO_E5B_IQ) return "7X"; + + if (type == CODETYPE_GALILEO_E5_I) return "8I"; + if (type == CODETYPE_GALILEO_E5_Q) return "8Q"; + if (type == CODETYPE_GALILEO_E5_IQ) return "8X"; + + if (type == CODETYPE_GALILEO_E6_A) return "6A"; + if (type == CODETYPE_GALILEO_E6_B) return "6B"; + if (type == CODETYPE_GALILEO_E6_C) return "6C"; + if (type == CODETYPE_GALILEO_E6_BC) return "6X"; + if (type == CODETYPE_GALILEO_E6_ABC) return "6Z"; + } + else if (system == 'J') { + if (type == CODETYPE_QZSS_L1_CA) return "1C"; + if (type == CODETYPE_QZSS_L1_S) return "1Z"; + + if (type == CODETYPE_QZSS_L1C_D) return "1S"; + if (type == CODETYPE_QZSS_L1C_P) return "1L"; + if (type == CODETYPE_QZSS_L1C_DP) return "1X"; + + if (type == CODETYPE_QZSS_L2C_M) return "2S"; + if (type == CODETYPE_QZSS_L2C_L) return "2L"; + if (type == CODETYPE_QZSS_L2C_ML) return "2X"; + + if (type == CODETYPE_QZSS_L5_I) return "5I"; + if (type == CODETYPE_QZSS_L5_Q) return "5Q"; + if (type == CODETYPE_QZSS_L5_IQ) return "5X"; + + if (type == CODETYPE_QZSS_L6_D) return "6S"; + if (type == CODETYPE_QZSS_L6_P) return "6L"; + if (type == CODETYPE_QZSS_L6_DP) return "6X"; + + if (type == CODETYPE_QZSS_L5_D) return "5D"; + if (type == CODETYPE_QZSS_L5_P) return "5P"; + if (type == CODETYPE_QZSS_L5_DP) return "5Z"; + + if (type == CODETYPE_QZSS_L6_E) return "6E"; + if (type == CODETYPE_QZSS_L6_DE) return "6Z"; + } + else if (system == 'C') { + if (type == CODETYPE_BDS_B1_I) return "2I"; + if (type == CODETYPE_BDS_B1_Q) return "2Q"; + if (type == CODETYPE_BDS_B1_IQ) return "2X"; + + if (type == CODETYPE_BDS_B3_I) return "6I"; + if (type == CODETYPE_BDS_B3_Q) return "6Q"; + if (type == CODETYPE_BDS_B3_IQ) return "6X"; + + if (type == CODETYPE_BDS_B2_I) return "7I"; + if (type == CODETYPE_BDS_B2_Q) return "7Q"; + if (type == CODETYPE_BDS_B2_IQ) return "7X"; + + if (type == CODETYPE_BDS_B1a_D) return "1D"; + if (type == CODETYPE_BDS_B1a_P) return "1P"; + if (type == CODETYPE_BDS_B1a_DP) return "1X"; + + if (type == CODETYPE_BDS_B2a_D) return "5D"; + if (type == CODETYPE_BDS_B2a_P) return "5P"; + if (type == CODETYPE_BDS_B2a_DP) return "5X"; + } + else if (system == 'S') { + if (type == CODETYPE_SBAS_L1_CA) return "1C"; + + if (type == CODETYPE_SBAS_L5_I) return "5I"; + if (type == CODETYPE_SBAS_L5_Q) return "5Q"; + if (type == CODETYPE_SBAS_L5_IQ) return "5X"; + } + return ""; +} + +// +//////////////////////////////////////////////////////////////////////////// +SsrCorr::CodeType SsrCorrRtcmNew::rnxTypeToCodeType(char system, std::string type) { + if (system == 'G') { + if (type.compare("1C") == 0) {return CODETYPE_GPS_L1_CA;} + if (type.compare("1P") == 0) {return CODETYPE_GPS_L1_P;} + if (type.compare("1W") == 0) {return CODETYPE_GPS_L1_Z;} + + if (type.compare("2D") == 0) {return CODETYPE_GPS_SEMI_CODELESS;} + if (type.compare("2C") == 0) {return CODETYPE_GPS_L2_CA;} + if (type.compare("2P") == 0) {return CODETYPE_GPS_L2_P;} + if (type.compare("2W") == 0) {return CODETYPE_GPS_L2_Z;} + if (type.compare("2S") == 0) {return CODETYPE_GPS_L2C_M;} + if (type.compare("2L") == 0) {return CODETYPE_GPS_L2C_L;} + if (type.compare("2X") == 0) {return CODETYPE_GPS_L2C_ML;} + + if (type.compare("5I") == 0) {return CODETYPE_GPS_L5_I;} + if (type.compare("5Q") == 0) {return CODETYPE_GPS_L5_Q;} + if (type.compare("5X") == 0) {return CODETYPE_GPS_L5_IQ;} + + if (type.compare("1S") == 0) {return CODETYPE_GPS_L1C_D;} + if (type.compare("1L") == 0) {return CODETYPE_GPS_L1C_P;} + if (type.compare("1X") == 0) {return CODETYPE_GPS_L1C_DP;} + } + else if (system == 'R') { + if (type.compare("1C") == 0) {return CODETYPE_GLONASS_L1_CA;} + if (type.compare("1P") == 0) {return CODETYPE_GLONASS_L1_P;} + if (type.compare("2C") == 0) {return CODETYPE_GLONASS_L2_CA;} + if (type.compare("2P") == 0) {return CODETYPE_GLONASS_L2_P;} + + if (type.compare("4A") == 0) {return CODETYPE_GLONASS_L1a_OCd;} + if (type.compare("4B") == 0) {return CODETYPE_GLONASS_L1a_OCp;} + if (type.compare("4X") == 0) {return CODETYPE_GLONASS_L1a_OCdp;} + + if (type.compare("6A") == 0) {return CODETYPE_GLONASS_L2a_CSI;} + if (type.compare("6B") == 0) {return CODETYPE_GLONASS_L2a_OCp;} + if (type.compare("6X") == 0) {return CODETYPE_GLONASS_L2a_CSIOCp;} + + if (type.compare("3I") == 0) {return CODETYPE_GLONASS_L3_I;} + if (type.compare("3Q") == 0) {return CODETYPE_GLONASS_L3_Q;} + if (type.compare("3X") == 0) {return CODETYPE_GLONASS_L3_IQ;} + } + else if (system == 'E') { + if (type.compare("1A") == 0) {return CODETYPE_GALILEO_E1_A;} + if (type.compare("1B") == 0) {return CODETYPE_GALILEO_E1_B;} + if (type.compare("1C") == 0) {return CODETYPE_GALILEO_E1_C;} + if (type.compare("1X") == 0) {return CODETYPE_GALILEO_E1_BC;} + if (type.compare("1Z") == 0) {return CODETYPE_GALILEO_E1_ABC;} + + if (type.compare("5I") == 0) {return CODETYPE_GALILEO_E5A_I;} + if (type.compare("5Q") == 0) {return CODETYPE_GALILEO_E5A_Q;} + if (type.compare("5X") == 0) {return CODETYPE_GALILEO_E5A_IQ;} + + if (type.compare("7I") == 0) {return CODETYPE_GALILEO_E5B_I;} + if (type.compare("7Q") == 0) {return CODETYPE_GALILEO_E5B_Q;} + if (type.compare("7X") == 0) {return CODETYPE_GALILEO_E5B_IQ;} + + if (type.compare("8I") == 0) {return CODETYPE_GALILEO_E5_I;} + if (type.compare("8Q") == 0) {return CODETYPE_GALILEO_E5_Q;} + if (type.compare("8X") == 0) {return CODETYPE_GALILEO_E5_IQ;} + + if (type.compare("6A") == 0) {return CODETYPE_GALILEO_E6_A;} + if (type.compare("6B") == 0) {return CODETYPE_GALILEO_E6_B;} + if (type.compare("6C") == 0) {return CODETYPE_GALILEO_E6_C;} + if (type.compare("6X") == 0) {return CODETYPE_GALILEO_E6_BC;} + if (type.compare("6Z") == 0) {return CODETYPE_GALILEO_E6_ABC;} + } + else if (system == 'J') { + if (type.compare("1C") == 0) {return CODETYPE_QZSS_L1_CA;} + if (type.compare("1Z") == 0) {return CODETYPE_QZSS_L1_S;} + + if (type.compare("1S") == 0) {return CODETYPE_QZSS_L1C_D;} + if (type.compare("1L") == 0) {return CODETYPE_QZSS_L1C_P;} + if (type.compare("1X") == 0) {return CODETYPE_QZSS_L1C_DP;} + + if (type.compare("2S") == 0) {return CODETYPE_QZSS_L2C_M;} + if (type.compare("2L") == 0) {return CODETYPE_QZSS_L2C_L;} + if (type.compare("2X") == 0) {return CODETYPE_QZSS_L2C_ML;} + + if (type.compare("5I") == 0) {return CODETYPE_QZSS_L5_I;} + if (type.compare("5Q") == 0) {return CODETYPE_QZSS_L5_Q;} + if (type.compare("5X") == 0) {return CODETYPE_QZSS_L5_IQ;} + + if (type.compare("6S") == 0) {return CODETYPE_QZSS_L6_D;} + if (type.compare("6L") == 0) {return CODETYPE_QZSS_L6_P;} + if (type.compare("6X") == 0) {return CODETYPE_QZSS_L6_DP;} + + if (type.compare("5D") == 0) {return CODETYPE_QZSS_L5_D;} + if (type.compare("5P") == 0) {return CODETYPE_QZSS_L5_P;} + if (type.compare("5Z") == 0) {return CODETYPE_QZSS_L5_DP;} + + if (type.compare("6E") == 0) {return CODETYPE_QZSS_L6_E;} + if (type.compare("6Z") == 0) {return CODETYPE_QZSS_L6_DE;} + } + else if (system == 'C') { + if (type.compare("2I") == 0) {return CODETYPE_BDS_B1_I;} + if (type.compare("2Q") == 0) {return CODETYPE_BDS_B1_Q;} + if (type.compare("2X") == 0) {return CODETYPE_BDS_B1_IQ;} + + if (type.compare("6I") == 0) {return CODETYPE_BDS_B3_I;} + if (type.compare("6Q") == 0) {return CODETYPE_BDS_B3_Q;} + if (type.compare("6X") == 0) {return CODETYPE_BDS_B3_IQ;} + + if (type.compare("7I") == 0) {return CODETYPE_BDS_B2_I;} + if (type.compare("7Q") == 0) {return CODETYPE_BDS_B2_Q;} + if (type.compare("7X") == 0) {return CODETYPE_BDS_B2_IQ;} + + if (type.compare("1D") == 0) {return CODETYPE_BDS_B1a_D;} + if (type.compare("1P") == 0) {return CODETYPE_BDS_B1a_P;} + if (type.compare("1X") == 0) {return CODETYPE_BDS_B1a_DP;} + + if (type.compare("5D") == 0) {return CODETYPE_BDS_B2a_D;} + if (type.compare("5P") == 0) {return CODETYPE_BDS_B2a_P;} + if (type.compare("5X") == 0) {return CODETYPE_BDS_B2a_DP;} + } + else if (system == 'S') { + if (type.compare("1C") == 0) {return CODETYPE_SBAS_L1_CA;} + + if (type.compare("5I") == 0) {return CODETYPE_SBAS_L5_I;} + if (type.compare("5Q") == 0) {return CODETYPE_SBAS_L5_Q;} + if (type.compare("5X") == 0) {return CODETYPE_SBAS_L5_IQ;} + } + return RESERVED; +} + Index: trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm_new.h =================================================================== --- trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm_new.h (revision 10754) +++ trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm_new.h (revision 10754) @@ -0,0 +1,243 @@ +#ifndef RTCM3_CLOCK_ORBIT_RTCM_NEW_H +#define RTCM3_CLOCK_ORBIT_RTCM_NEW_H + +/* Programheader + + Name: clock_orbit_rtcm_new.h + Project: RTCM3 + Version: $Id: clock_orbit_rtcm_new.h 9050 2020-08-27 14:01:42Z stuerze $ + Authors: Dirk Stöcker, Andrea Stürze + Description: state space approach: RTCM_NEW + */ + +#include +#include "clock_orbit.h" + +class SsrCorrRtcmNew: public SsrCorr { + +public: + SsrCorrRtcmNew(); + ~SsrCorrRtcmNew(); + + void setCorBase() { + COBBASE_GPS = 1057; + COBBASE_GLONASS = 41; + COBBASE_GALILEO = 1240; + COBBASE_QZSS = 1246; + COBBASE_SBAS = 1252; + COBBASE_BDS = 1258; + COBBASE_NUM = 6; + corbase << COBBASE_GPS + << COBBASE_GLONASS + << COBBASE_GALILEO + << COBBASE_QZSS + << COBBASE_SBAS + << COBBASE_BDS; + }; + + void setCorOffset() { + COBOFS_ORBIT = 0; + COBOFS_CLOCK = 1; + COBOFS_CBIAS = 2; + COBOFS_COMBINED = 3; + COBOFS_URA = 4; + COBOFS_HR = 5; + COBOFS_NUM = 6; + }; + + void setCoType() { + COTYPE_GPSORBIT = COBBASE_GPS + COBOFS_ORBIT; + COTYPE_GPSCLOCK = COTYPE_GPSORBIT + 1; + COTYPE_GPSCOMBINED = COBBASE_GPS + COBOFS_COMBINED; + COTYPE_GPSURA = COTYPE_GPSCOMBINED + 1; + COTYPE_GPSHR = COTYPE_GPSURA + 1; + + COTYPE_GLONASSORBIT = COBBASE_GLONASS + COBOFS_ORBIT; + COTYPE_GLONASSCLOCK = COTYPE_GLONASSORBIT + 1; + COTYPE_GLONASSCOMBINED = COBBASE_GLONASS + COBOFS_COMBINED; + COTYPE_GLONASSURA = COTYPE_GLONASSCOMBINED + 1; + COTYPE_GLONASSHR = COTYPE_GLONASSURA + 1; + + COTYPE_GALILEOORBIT = COBBASE_GALILEO + COBOFS_ORBIT, + COTYPE_GALILEOCLOCK = COTYPE_GALILEOORBIT + 1; + COTYPE_GALILEOCOMBINED = COBBASE_GALILEO + COBOFS_COMBINED; + COTYPE_GALILEOURA = COTYPE_GALILEOCOMBINED + 1; + COTYPE_GALILEOHR = COTYPE_GALILEOURA + 1; + + COTYPE_QZSSORBIT = COBBASE_QZSS + COBOFS_ORBIT; + COTYPE_QZSSCLOCK = COTYPE_QZSSORBIT + 1; + COTYPE_QZSSCOMBINED = COBBASE_QZSS + COBOFS_COMBINED, + COTYPE_QZSSURA = COTYPE_QZSSCOMBINED + 1; + COTYPE_QZSSHR = COTYPE_QZSSURA + 1; + + COTYPE_SBASORBIT = COBBASE_SBAS + COBOFS_ORBIT; + COTYPE_SBASCLOCK = COTYPE_SBASORBIT + 1; + COTYPE_SBASCOMBINED = COBBASE_SBAS + COBOFS_COMBINED; + COTYPE_SBASURA = COTYPE_SBASCOMBINED + 1; + COTYPE_SBASHR = COTYPE_SBASURA + 1; + + COTYPE_BDSORBIT = COBBASE_BDS + COBOFS_ORBIT; + COTYPE_BDSCLOCK = COTYPE_BDSORBIT + 1; + COTYPE_BDSCOMBINED = COBBASE_BDS + COBOFS_COMBINED, + COTYPE_BDSURA = COTYPE_BDSCOMBINED + 1; + COTYPE_BDSHR = COTYPE_BDSURA + 1; + + COTYPE_AUTO = 0; + }; + + void setCbType() { + CBTYPE_GPS = COBBASE_GPS + COBOFS_CBIAS; + CBTYPE_GLONASS = COBBASE_GLONASS + COBOFS_CBIAS; + CBTYPE_GALILEO = COBBASE_GALILEO + COBOFS_CBIAS; + CBTYPE_QZSS = COBBASE_QZSS + COBOFS_CBIAS; + CBTYPE_SBAS = COBBASE_SBAS + COBOFS_CBIAS; + CBTYPE_BDS = COBBASE_BDS + COBOFS_CBIAS; + CBTYPE_AUTO = 0; + }; + + void setPbType() { + PBTYPE_BASE = 85; + PBTYPE_GPS = PBTYPE_BASE; + PBTYPE_GLONASS = PBTYPE_GPS++; + PBTYPE_GALILEO = PBTYPE_GLONASS++; + PBTYPE_BDS = PBTYPE_GALILEO++; + PBTYPE_QZSS = PBTYPE_BDS++; + PBTYPE_AUTO = 0; + }; + + void setPbExtType() { + PBEXTTYPE_BASE = 90; + PBEXTTYPE_GPS = PBEXTTYPE_BASE; + PBEXTTYPE_GLONASS = PBEXTTYPE_GPS++; + PBEXTTYPE_GALILEO = PBEXTTYPE_GLONASS++; + PBEXTTYPE_BDS = PBEXTTYPE_GALILEO++; + PBEXTTYPE_QZSS = PBEXTTYPE_BDS++; + PBEXTTYPE_AUTO = 0; + }; + + + void setVtecType() { + VTEC_BASE = 1264; + }; + + void setCodeType() { + RESERVED = 99; + + CODETYPE_GPS_L1_CA = 0; + CODETYPE_GPS_L1_P = 1; + CODETYPE_GPS_L1_Z = 2; + + + CODETYPE_GPS_L2_CA = 5; + CODETYPE_GPS_SEMI_CODELESS = 6; + CODETYPE_GPS_L2C_M = 7; + CODETYPE_GPS_L2C_L = 8; + CODETYPE_GPS_L2C_ML = 9; + CODETYPE_GPS_L2_P = 10; + CODETYPE_GPS_L2_Z = 11; + + + CODETYPE_GPS_L5_I = 14; + CODETYPE_GPS_L5_Q = 15; + CODETYPE_GPS_L5_IQ = 16; + CODETYPE_GPS_L1C_D = 17; + CODETYPE_GPS_L1C_P = 18; + CODETYPE_GPS_L1C_DP = 19; + + CODETYPE_GLONASS_L1_CA = 0; + CODETYPE_GLONASS_L1_P = 1; + CODETYPE_GLONASS_L2_CA = 2; + CODETYPE_GLONASS_L2_P = 3; + CODETYPE_GLONASS_L1a_OCd = 4; + CODETYPE_GLONASS_L1a_OCp = 5; + CODETYPE_GLONASS_L1a_OCdp = 6; + CODETYPE_GLONASS_L2a_CSI = 7; + CODETYPE_GLONASS_L2a_OCp = 8; + CODETYPE_GLONASS_L2a_CSIOCp = 9; + CODETYPE_GLONASS_L3_I = 10; + CODETYPE_GLONASS_L3_Q = 11; + CODETYPE_GLONASS_L3_IQ = 12; + + CODETYPE_GALILEO_E1_A = 0; + CODETYPE_GALILEO_E1_B = 1; + CODETYPE_GALILEO_E1_C = 2; + CODETYPE_GALILEO_E1_BC = 3; + CODETYPE_GALILEO_E1_ABC = 4; + CODETYPE_GALILEO_E5A_I = 5; + CODETYPE_GALILEO_E5A_Q = 6; + CODETYPE_GALILEO_E5A_IQ = 7; + CODETYPE_GALILEO_E5B_I = 8; + CODETYPE_GALILEO_E5B_Q = 9; + CODETYPE_GALILEO_E5B_IQ = 10; + CODETYPE_GALILEO_E5_I = 11; + CODETYPE_GALILEO_E5_Q = 12; + CODETYPE_GALILEO_E5_IQ = 13; + CODETYPE_GALILEO_E6_A = 14; + CODETYPE_GALILEO_E6_B = 15; + CODETYPE_GALILEO_E6_C = 16; + CODETYPE_GALILEO_E6_BC = 17; + CODETYPE_GALILEO_E6_ABC = 18; + + CODETYPE_QZSS_L1_CA = 0; + CODETYPE_QZSS_L1C_D = 1; + CODETYPE_QZSS_L1C_P = 2; + CODETYPE_QZSS_L2C_M = 3; + CODETYPE_QZSS_L2C_L = 4; + CODETYPE_QZSS_L2C_ML = 5; + CODETYPE_QZSS_L5_I = 6; + CODETYPE_QZSS_L5_Q = 7; + CODETYPE_QZSS_L5_IQ = 8; + CODETYPE_QZSS_L6_D = 9; + CODETYPE_QZSS_L6_P = 10; + CODETYPE_QZSS_L6_DP = 11; + CODETYPE_QZSS_L1C_DP = 12; + CODETYPE_QZSS_L1_S = 13; + CODETYPE_QZSS_L5_D = 14; + CODETYPE_QZSS_L5_P = 15; + CODETYPE_QZSS_L5_DP = 16; + CODETYPE_QZSS_L6_E = 17; + CODETYPE_QZSS_L6_DE = 18; + + CODETYPE_SBAS_L1_CA = 0; + CODETYPE_SBAS_L5_I = 1; + CODETYPE_SBAS_L5_Q = 2; + CODETYPE_SBAS_L5_IQ = 3; + + CODETYPE_BDS_B1_I = 0; + CODETYPE_BDS_B1_Q = 1; + CODETYPE_BDS_B1_IQ = 2; + CODETYPE_BDS_B3_I = 3; + CODETYPE_BDS_B3_Q = 4; + CODETYPE_BDS_B3_IQ = 5; + CODETYPE_BDS_B2_I = 6; + CODETYPE_BDS_B2_Q = 7; + CODETYPE_BDS_B2_IQ = 8; + CODETYPE_BDS_B1a_D = 9; + CODETYPE_BDS_B1a_P = 10; + CODETYPE_BDS_B1a_DP = 11; + CODETYPE_BDS_B2a_D = 12; + CODETYPE_BDS_B2a_P = 13; + CODETYPE_BDS_B2a_DP = 14; + + + + + } + + std::string codeTypeToRnxType(char system, CodeType type); + SsrCorr::CodeType rnxTypeToCodeType(char system, std::string type); + + size_t MakeClockOrbit(const struct ClockOrbit *co, ClockOrbitType type, + int moremessagesfollow, char *buffer, size_t size); + size_t MakeCodeBias(const struct CodeBias *b, CodeBiasType type, + int moremessagesfollow, char *buffer, size_t size); + size_t MakePhaseBias(const struct PhaseBias *b, PhaseBiasType type, + int moremessagesfollow, char *buffer, size_t size); + size_t MakeVTEC(const struct VTEC *v, int moremessagesfollow, char *buffer, + size_t size); + enum GCOB_RETURN GetSSR(struct ClockOrbit *co, struct CodeBias *b, + struct VTEC *v, struct PhaseBias *pb, const char *buffer, size_t size, + int *bytesused); + }; + +#endif /* RTCM3_CLOCK_ORBIT_RTCM_H */ Index: trunk/BNC/src/combination/bnccomb.cpp =================================================================== --- trunk/BNC/src/combination/bnccomb.cpp (revision 10753) +++ trunk/BNC/src/combination/bnccomb.cpp (revision 10754) @@ -208,4 +208,7 @@ _ssrCorr = new SsrCorrRtcm(); } + else if (ssrFormat == "RTCM-NEW-SSR") { + _ssrCorr = new SsrCorrRtcmNew(); + } else { // default _ssrCorr = new SsrCorrIgs(); Index: trunk/BNC/src/combination/bnccomb.h =================================================================== --- trunk/BNC/src/combination/bnccomb.h (revision 10753) +++ trunk/BNC/src/combination/bnccomb.h (revision 10754) @@ -19,4 +19,5 @@ #include "bncoutf.h" #include "../RTCM3/clock_and_orbit/clock_orbit_rtcm.h" +#include "../RTCM3/clock_and_orbit/clock_orbit_rtcm_new.h" #include "../RTCM3/clock_and_orbit/clock_orbit_igs.h" Index: trunk/BNC/src/upload/bncephuploadcaster.cpp =================================================================== --- trunk/BNC/src/upload/bncephuploadcaster.cpp (revision 10753) +++ trunk/BNC/src/upload/bncephuploadcaster.cpp (revision 10754) @@ -27,8 +27,8 @@ bncEphUploadCaster::bncEphUploadCaster() : bncEphUser(true) { bncSettings settings; - int sampl = settings.value("uploadSamplRtcmEph").toInt(); + int sampl = settings.value("uploadSamplRtcmEph").toInt(); - // List of upload casters - // ---------------------- + // List of upload ephUploadCasters + // ------------------------------- int iRow = -1; QListIterator it(settings.value("uploadEphMountpointsOut").toStringList()); Index: trunk/BNC/src/upload/bncrtnetuploadcaster.cpp =================================================================== --- trunk/BNC/src/upload/bncrtnetuploadcaster.cpp (revision 10753) +++ trunk/BNC/src/upload/bncrtnetuploadcaster.cpp (revision 10754) @@ -70,4 +70,7 @@ else if (_ssrFormat == "RTCM-SSR") { _ssrCorr = new SsrCorrRtcm(); + } + else if (ssrFormat == "RTCM-NEW-SSR") { + _ssrCorr = new SsrCorrRtcmNew(); } Index: trunk/BNC/src/upload/bncrtnetuploadcaster.h =================================================================== --- trunk/BNC/src/upload/bncrtnetuploadcaster.h (revision 10753) +++ trunk/BNC/src/upload/bncrtnetuploadcaster.h (revision 10754) @@ -8,4 +8,5 @@ #include "ephemeris.h" #include "../RTCM3/clock_and_orbit/clock_orbit_rtcm.h" +#include "../RTCM3/clock_and_orbit/clock_orbit_rtcm_new.h" #include "../RTCM3/clock_and_orbit/clock_orbit_igs.h" #include "../RTCM3/crs.h" @@ -54,5 +55,5 @@ QString _casterID; - bncEphUser* _ephUser; + bncEphUser* _ephUser; QString _rtnetStreamBuffer; QString _crdTrafoStr;