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.Rtcm1045;
27 import org.orekit.gnss.metric.messages.rtcm.ephemeris.Rtcm1045Data;
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.GalileoNavigationMessage;
34 import org.orekit.time.GNSSDate;
35
36 import java.util.ArrayList;
37
38 public class Rtcm1045Test {
39
40 private final double eps = 8.2e-10;
41
42 @BeforeEach
43 public void setUp() {
44 Utils.setDataRoot("gnss");
45 }
46
47 @Test
48 public void testParseMessage() {
49
50 final String m = "010000010101" +
51 "001100" +
52 "111111101111" +
53 "1000010000" +
54 "01011110" +
55 "01011101111101" +
56 "00001111011011" +
57 "011111" +
58 "000010101111110111011" +
59 "0100101011111101111111101010011" +
60 "0000000000000000" +
61 "0111111011001111" +
62 "00000110110011111011100110011011" +
63 "0000000000000000" +
64 "00010011111101111000111000011001" +
65 "0000000000000000" +
66 "10100001000011000111111111111111" +
67 "10001000111011" +
68 "0000000000000000" +
69 "00011100011100000111111000111111" +
70 "0000000000000000" +
71 "00101000001111100011110011110000" +
72 "0000000000000000" +
73 "00001100001111100011110011110000" +
74 "111111111011111111110100" +
75 "0001101101" +
76 "00" +
77 "0" +
78 "0000000";
79
80
81 final EncodedMessage message = new ByteArrayEncodedMessage(byteArrayFromBinary(m));
82 message.start();
83
84 ArrayList<Integer> messages = new ArrayList<>();
85 messages.add(1045);
86
87 final Rtcm1045 rtcm1045 = (Rtcm1045) new RtcmMessagesParser(messages, DataContext.getDefault().getTimeScales()).
88 parse(message, false);
89 final Rtcm1045Data ephemerisData = rtcm1045.getEphemerisData();
90 final GalileoNavigationMessage galileoMessage = ephemerisData.getGalileoNavigationMessage();
91
92
93 final GNSSPropagator propagator = new GNSSPropagatorBuilder(galileoMessage).build();
94 Assertions.assertNotNull(propagator);
95 Assertions.assertEquals(0.0, galileoMessage.getDate().
96 durationFrom(new GNSSDate(galileoMessage.getWeek(), galileoMessage.getTime(), SatelliteSystem.GALILEO).getDate()), eps);
97
98
99 Assertions.assertEquals(1045, rtcm1045.getTypeCode());
100 Assertions.assertEquals(1, rtcm1045.getData().size());
101
102
103 Assertions.assertEquals(12, galileoMessage.getPRN());
104 Assertions.assertEquals(4079, galileoMessage.getWeek());
105 Assertions.assertEquals(2.1475894557210572E-9, galileoMessage.getIDot(), eps);
106 Assertions.assertEquals(528, galileoMessage.getIODNav(), eps);
107 Assertions.assertEquals(3.3776428E-17, galileoMessage.getAf2(), eps);
108 Assertions.assertEquals(1.279588E-9, galileoMessage.getAf1(), eps);
109 Assertions.assertEquals(0.036617268982809, galileoMessage.getAf0(), eps);
110 Assertions.assertEquals(0.0, galileoMessage.getCrs(), eps);
111 Assertions.assertEquals(1.458633710547623E-4, galileoMessage.getMeanMotion0(), eps);
112 Assertions.assertEquals(1.4587496546628753E-4, galileoMessage.getMeanMotion0() + galileoMessage.getDeltaN0(), eps);
113 Assertions.assertEquals(0.1671775426328288, galileoMessage.getM0(), eps);
114 Assertions.assertEquals(0.0, galileoMessage.getCuc(), eps);
115 Assertions.assertEquals(0.0389980711042881, galileoMessage.getE(), eps);
116 Assertions.assertEquals(0.0, galileoMessage.getCus(), eps);
117 Assertions.assertEquals(5153.562498092651, FastMath.sqrt(galileoMessage.getSma()), eps);
118 Assertions.assertEquals(525780.0, galileoMessage.getTime(), eps);
119 Assertions.assertEquals(0.0, galileoMessage.getCic(), eps);
120 Assertions.assertEquals(0.0, galileoMessage.getCis(), eps);
121 Assertions.assertEquals(0.987714701321906, galileoMessage.getI0(), eps);
122 Assertions.assertEquals(0.0, galileoMessage.getCrc(), eps);
123 Assertions.assertEquals(0.30049130834913723, galileoMessage.getPa(), eps);
124 Assertions.assertEquals(-5.855958209879004E-9, galileoMessage.getOmegaDot(), eps);
125 Assertions.assertEquals(0.6980085385373721, galileoMessage.getOmega0(), eps);
126 Assertions.assertEquals(2.537854E-8, galileoMessage.getBGDE1E5a(), eps);
127
128
129 Assertions.assertEquals(12, ephemerisData.getSatelliteID());
130 Assertions.assertEquals(59220.0, ephemerisData.getGalileoToc(), eps);
131 Assertions.assertEquals(0, ephemerisData.getGalileoDataValidityStatus());
132 Assertions.assertEquals(ephemerisData.getAccuracyProvider().getAccuracy(), galileoMessage.getSisa(), eps);
133
134 }
135
136 @Test
137 public void testNullMessage() {
138
139 final String m = "010000010101" +
140 "001100" +
141 "111111101111" +
142 "1000010000" +
143 "01011110" +
144 "01011101111101" +
145 "00001111011011" +
146 "011111" +
147 "000010101111110111011" +
148 "0100101011111101111111101010011" +
149 "0000000000000000" +
150 "0111111011001111" +
151 "00000110110011111011100110011011" +
152 "0000000000000000" +
153 "00010011111101111000111000011001" +
154 "0000000000000000" +
155 "10100001000011000111111111111111" +
156 "10001000111011" +
157 "0000000000000000" +
158 "00011100011100000111111000111111" +
159 "0000000000000000" +
160 "00101000001111100011110011110000" +
161 "0000000000000000" +
162 "00001100001111100011110011110000" +
163 "111111111011111111110100" +
164 "0001101101" +
165 "00" +
166 "0" +
167 "0000000";
168
169 final EncodedMessage message = new ByteArrayEncodedMessage(byteArrayFromBinary(m));
170 message.start();
171
172 ArrayList<Integer> messages = new ArrayList<>();
173 messages.add(9999999);
174
175 final Rtcm1045 rtcm1045 = (Rtcm1045) new RtcmMessagesParser(messages, DataContext.getDefault().getTimeScales()).
176 parse(message, false);
177
178 Assertions.assertNull(rtcm1045);
179 }
180
181
182 private byte[] byteArrayFromBinary(String radix2Value) {
183 final byte[] array = new byte[radix2Value.length() / 8];
184 for (int i = 0; i < array.length; ++i) {
185 for (int j = 0; j < 8; ++j) {
186 if (radix2Value.charAt(8 * i + j) != '0') {
187 array[i] |= 0x1 << (7 - j);
188 }
189 }
190 }
191 return array;
192 }
193
194 }