1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17 package org.orekit.gnss.metric.messages.rtcm;
18
19 import org.hipparchus.util.FastMath;
20 import org.junit.jupiter.api.Assertions;
21 import org.junit.jupiter.api.BeforeEach;
22 import org.junit.jupiter.api.Test;
23 import org.orekit.Utils;
24 import org.orekit.data.DataContext;
25 import org.orekit.gnss.SatelliteSystem;
26 import org.orekit.gnss.metric.messages.rtcm.ephemeris.Rtcm1042;
27 import org.orekit.gnss.metric.messages.rtcm.ephemeris.Rtcm1042Data;
28 import org.orekit.gnss.metric.parser.ByteArrayEncodedMessage;
29 import org.orekit.gnss.metric.parser.EncodedMessage;
30 import org.orekit.gnss.metric.parser.RtcmMessagesParser;
31 import org.orekit.propagation.analytical.gnss.GNSSPropagator;
32 import org.orekit.propagation.analytical.gnss.GNSSPropagatorBuilder;
33 import org.orekit.propagation.analytical.gnss.data.BeidouLegacyNavigationMessage;
34 import org.orekit.time.GNSSDate;
35
36 import java.util.ArrayList;
37
38 public class Rtcm1042Test {
39
40 private final double eps = 1.0e-15;
41
42 @BeforeEach
43 public void setUp() {
44 Utils.setDataRoot("gnss");
45 }
46
47 @Test
48 public void testParseMessage() {
49
50 final String m = "010000010010" +
51 "001100" +
52 "1111111011101" +
53 "0001" +
54 "01011101111101" +
55 "10100" +
56 "00001111011011111" +
57 "01111111000" +
58 "0000101011111101110010" +
59 "010010101111110111111111" +
60 "10100" +
61 "000000000000000000" +
62 "0111111011001111" +
63 "00000110110011111011100110011011" +
64 "000000000000000000" +
65 "00010011111101111000111000011001" +
66 "000000000000000000" +
67 "10100001000011000111111111111111" +
68 "10001000111000111" +
69 "000000000000000000" +
70 "00011100011100000111111000111111" +
71 "000000000000000000" +
72 "00101000001111100011110011110000" +
73 "000000000000000000" +
74 "00001100001111100011110011110000" +
75 "111111111011111111110100" +
76 "0001001111" +
77 "0111001111" +
78 "0" +
79 "0";
80
81 final EncodedMessage message = new ByteArrayEncodedMessage(byteArrayFromBinary(m));
82 message.start();
83
84 ArrayList<Integer> messages = new ArrayList<>();
85 messages.add(1042);
86
87 final Rtcm1042 rtcm1042 = (Rtcm1042) new RtcmMessagesParser(messages, DataContext.getDefault().getTimeScales()).
88 parse(message, false);
89 final Rtcm1042Data ephemerisData = rtcm1042.getEphemerisData();
90 final BeidouLegacyNavigationMessage beidouMessage = ephemerisData.getBeidouNavigationMessage();
91
92
93 final GNSSPropagator propagator = new GNSSPropagatorBuilder(beidouMessage).build();
94 Assertions.assertNotNull(propagator);
95 Assertions.assertEquals(0.0, beidouMessage.getDate().
96 durationFrom(new GNSSDate(beidouMessage.getWeek(), beidouMessage.getTime(), SatelliteSystem.BEIDOU).getDate()), eps);
97
98
99 Assertions.assertEquals(1042, rtcm1042.getTypeCode());
100 Assertions.assertEquals(1, rtcm1042.getData().size());
101
102
103 Assertions.assertEquals(12, beidouMessage.getPRN());
104 Assertions.assertEquals(8157, beidouMessage.getWeek());
105 Assertions.assertEquals(2.1475894557210572E-9, beidouMessage.getIDot(), eps);
106 Assertions.assertEquals(20, beidouMessage.getAODE(), eps);
107 Assertions.assertEquals(1.3769368E-17, beidouMessage.getAf2(), eps);
108 Assertions.assertEquals(1.5994495E-10, beidouMessage.getAf1(), eps);
109 Assertions.assertEquals(5.721448687836528E-4, beidouMessage.getAf0(), eps);
110 Assertions.assertEquals(20, beidouMessage.getAODC());
111 Assertions.assertEquals(0.0, beidouMessage.getCrs(), eps);
112 Assertions.assertEquals(1.458633710547623E-4, beidouMessage.getMeanMotion0(), eps);
113 Assertions.assertEquals(1.4587496546628753E-4, beidouMessage.getMeanMotion0() + beidouMessage.getDeltaN0(), eps);
114 Assertions.assertEquals(0.1671775426328288, beidouMessage.getM0(), eps);
115 Assertions.assertEquals(0.0, beidouMessage.getCuc(), eps);
116 Assertions.assertEquals(0.03899807028938085, beidouMessage.getE(), eps);
117 Assertions.assertEquals(0.0, beidouMessage.getCus(), eps);
118 Assertions.assertEquals(5153.562498092651, FastMath.sqrt(beidouMessage.getSma()), eps);
119 Assertions.assertEquals(560696.0, beidouMessage.getTime(), eps);
120 Assertions.assertEquals(0.0, beidouMessage.getCic(), eps);
121 Assertions.assertEquals(0.0, beidouMessage.getCis(), eps);
122 Assertions.assertEquals(0.987714701321906, beidouMessage.getI0(), eps);
123 Assertions.assertEquals(0.0, beidouMessage.getCrc(), eps);
124 Assertions.assertEquals(0.30049130834913723, beidouMessage.getPa(), eps);
125 Assertions.assertEquals(-5.855958209879004E-9, beidouMessage.getOmegaDot(), eps);
126 Assertions.assertEquals(0.6980085385373721, beidouMessage.getOmega0(), eps);
127 Assertions.assertEquals(7.9E-9, beidouMessage.getTGD1(), eps);
128 Assertions.assertEquals(4.63E-8, beidouMessage.getTGD2(), eps);
129
130
131 Assertions.assertEquals(12, ephemerisData.getSatelliteID());
132 Assertions.assertEquals(0.0, ephemerisData.getSvHealth(), eps);
133 Assertions.assertEquals(63224, ephemerisData.getBeidouToc(), eps);
134 Assertions.assertEquals(ephemerisData.getAccuracyProvider().getAccuracy(), beidouMessage.getSvAccuracy(), eps);
135
136 }
137
138 @Test
139 public void testNullMessage() {
140
141 final String m = "010000010010" +
142 "001100" +
143 "1111111011101" +
144 "0001" +
145 "01011101111101" +
146 "10100" +
147 "00001111011011111" +
148 "01111111000" +
149 "0000101011111101110010" +
150 "010010101111110111111111" +
151 "10100" +
152 "000000000000000000" +
153 "0111111011001111" +
154 "00000110110011111011100110011011" +
155 "000000000000000000" +
156 "00010011111101111000111000011001" +
157 "000000000000000000" +
158 "10100001000011000111111111111111" +
159 "10001000111000111" +
160 "000000000000000000" +
161 "00011100011100000111111000111111" +
162 "000000000000000000" +
163 "00101000001111100011110011110000" +
164 "000000000000000000" +
165 "00001100001111100011110011110000" +
166 "111111111011111111110100" +
167 "0001001111" +
168 "0111001111" +
169 "0" +
170 "0";
171
172 final EncodedMessage message = new ByteArrayEncodedMessage(byteArrayFromBinary(m));
173 message.start();
174
175 ArrayList<Integer> messages = new ArrayList<>();
176 messages.add(9999999);
177
178 final Rtcm1042 rtcm1042 = (Rtcm1042) new RtcmMessagesParser(messages, DataContext.getDefault().getTimeScales()).
179 parse(message, false);
180
181 Assertions.assertNull(rtcm1042);
182 }
183
184
185 private byte[] byteArrayFromBinary(String radix2Value) {
186 final byte[] array = new byte[radix2Value.length() / 8];
187 for (int i = 0; i < array.length; ++i) {
188 for (int j = 0; j < 8; ++j) {
189 if (radix2Value.charAt(8 * i + j) != '0') {
190 array[i] |= 0x1 << (7 - j);
191 }
192 }
193 }
194 return array;
195 }
196
197 }