[10534] | 1 | /*
|
---|
| 2 | * crsEncoder.cpp
|
---|
| 3 | *
|
---|
| 4 | * Created on: Jun 18, 2024
|
---|
| 5 | * Author: stuerze
|
---|
| 6 | */
|
---|
| 7 |
|
---|
| 8 |
|
---|
| 9 | #include "crsEncoder.h"
|
---|
| 10 |
|
---|
| 11 | using namespace std;
|
---|
| 12 |
|
---|
| 13 | // build up RTCM3 for serviceCrs
|
---|
| 14 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 15 | int t_crsEncoder::RTCM3(const t_serviceCrs& serviceCrs, char *buffer, size_t size) {
|
---|
| 16 | STARTDATA
|
---|
| 17 | INITBLOCK
|
---|
| 18 | ADDBITS(12, 1300)
|
---|
| 19 | int N = sizeof(serviceCrs._name) / sizeof(serviceCrs._name[0]);
|
---|
| 20 | if (N > 31) {N = 31;}
|
---|
| 21 | ADDBITS(5, N)
|
---|
| 22 | for(int i = 0; i < N; i++) {
|
---|
| 23 | ADDBITS(8, serviceCrs._name[i])
|
---|
| 24 | }
|
---|
| 25 | SCALEADDBITS(16, 100, serviceCrs._CE)
|
---|
| 26 | ENDBLOCK
|
---|
| 27 | return ressize;
|
---|
| 28 | }
|
---|
| 29 |
|
---|
| 30 | // build up RTCM3 for rtcmCrs
|
---|
| 31 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 32 | int t_crsEncoder::RTCM3(const t_rtcmCrs& rtcmCrs, char *buffer, size_t size) {
|
---|
| 33 | STARTDATA
|
---|
| 34 | INITBLOCK
|
---|
| 35 |
|
---|
| 36 | ADDBITS(12, 1302)
|
---|
| 37 | int N = sizeof(rtcmCrs._name) / sizeof(rtcmCrs._name[0]);
|
---|
| 38 | if (N > 31) {N = 31;}
|
---|
| 39 | ADDBITS(5, N)
|
---|
| 40 | for(int i = 0; i < N; i++) {
|
---|
| 41 | ADDBITS(8, rtcmCrs._name[i])
|
---|
| 42 | }
|
---|
| 43 | ADDBITS(1, rtcmCrs._anchor)
|
---|
| 44 | ADDBITS(5, rtcmCrs._plateNumber)
|
---|
| 45 | int dblinknum = rtcmCrs._databaseLinks.size();
|
---|
| 46 | ADDBITS(3, dblinknum);
|
---|
| 47 | if (dblinknum) {
|
---|
| 48 | for(int d = 0; d < dblinknum; d++) {
|
---|
| 49 | N = sizeof(rtcmCrs._databaseLinks[d]) / sizeof(rtcmCrs._databaseLinks[d][0]);
|
---|
| 50 | for(int i = 0; i < N; i++) {
|
---|
| 51 | ADDBITS(8, rtcmCrs._databaseLinks[d].toLatin1()[i])
|
---|
| 52 | }
|
---|
| 53 | }
|
---|
| 54 | }
|
---|
| 55 | ENDBLOCK
|
---|
| 56 | return ressize;
|
---|
| 57 | }
|
---|
| 58 |
|
---|
| 59 | // build up RTCM3 for
|
---|
| 60 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 61 | int t_crsEncoder::RTCM3(const t_helmertPar& helmertPar, char *buffer, size_t size) {
|
---|
| 62 |
|
---|
| 63 | STARTDATA
|
---|
| 64 | INITBLOCK
|
---|
| 65 |
|
---|
| 66 | ADDBITS(12, 1301)
|
---|
| 67 |
|
---|
| 68 | ENDBLOCK
|
---|
| 69 | return ressize;
|
---|
| 70 | }
|
---|
| 71 |
|
---|