1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17 package org.orekit.gnss.metric.ntrip;
18
19 import java.io.BufferedReader;
20 import java.io.IOException;
21 import java.io.InputStream;
22 import java.io.InputStreamReader;
23 import java.net.Authenticator;
24 import java.net.HttpURLConnection;
25 import java.net.InetAddress;
26 import java.net.InetSocketAddress;
27 import java.net.Proxy;
28 import java.net.Proxy.Type;
29 import java.net.SocketAddress;
30 import java.net.URI;
31 import java.net.URISyntaxException;
32 import java.net.URL;
33 import java.net.URLConnection;
34 import java.net.UnknownHostException;
35 import java.nio.charset.StandardCharsets;
36 import java.util.ArrayList;
37 import java.util.Formatter;
38 import java.util.HashMap;
39 import java.util.List;
40 import java.util.Locale;
41 import java.util.Map;
42 import java.util.concurrent.ExecutorService;
43 import java.util.concurrent.Executors;
44 import java.util.concurrent.TimeUnit;
45 import java.util.concurrent.atomic.AtomicReference;
46
47 import org.hipparchus.util.FastMath;
48 import org.orekit.errors.OrekitException;
49 import org.orekit.errors.OrekitMessages;
50 import org.orekit.gnss.metric.messages.ParsedMessage;
51 import org.orekit.time.TimeScales;
52
53
54
55
56
57
58
59
60
61
62 public class NtripClient {
63
64
65 public static final int DEFAULT_TIMEOUT = 10000;
66
67
68 public static final int DEFAULT_PORT = 2101;
69
70
71 public static final double DEFAULT_RECONNECT_DELAY = 1.0;
72
73
74 public static final double DEFAULT_RECONNECT_DELAY_FACTOR = 1.5;
75
76
77 public static final int DEFAULT_MAX_RECONNECT = 20;
78
79
80 private static final String HOST_HEADER_KEY = "Host";
81
82
83 private static final String USER_AGENT_HEADER_KEY = "User-Agent";
84
85
86 private static final String USER_AGENT_HEADER_VALUE = "NTRIP orekit/11.0";
87
88
89 private static final String VERSION_HEADER_KEY = "Ntrip-Version";
90
91
92 private static final String VERSION_HEADER_VALUE = "Ntrip/2.0";
93
94
95 private static final String CONNECTION_HEADER_KEY = "Connection";
96
97
98 private static final String CONNECTION_HEADER_VALUE = "close";
99
100
101 private static final String FLAGS_HEADER_KEY = "Ntrip-Flags";
102
103
104 private static final String SOURCETABLE_CONTENT_TYPE = "gnss/sourcetable";
105
106
107 private static final double DEG_TO_MINUTES = 60.0;
108
109
110 private final String host;
111
112
113 private final int port;
114
115
116 private double reconnectDelay;
117
118
119 private double reconnectDelayFactor;
120
121
122 private int maxRetries;
123
124
125 private int timeout;
126
127
128 private Proxy proxy;
129
130
131 private AtomicReference<String> gga;
132
133
134 private final List<ObserverHolder> observers;
135
136
137 private final Map<String, StreamMonitor> monitors;
138
139
140 private SourceTable sourceTable;
141
142
143 private ExecutorService executorService;
144
145
146
147
148 private final TimeScales timeScales;
149
150
151
152
153
154
155
156
157
158
159
160
161 public NtripClient(final String host, final int port, final TimeScales timeScales) {
162 this.host = host;
163 this.port = port;
164 this.observers = new ArrayList<>();
165 this.monitors = new HashMap<>();
166 setTimeout(DEFAULT_TIMEOUT);
167 setReconnectParameters(DEFAULT_RECONNECT_DELAY,
168 DEFAULT_RECONNECT_DELAY_FACTOR,
169 DEFAULT_MAX_RECONNECT);
170 setProxy(Type.DIRECT, null, -1);
171 this.gga = new AtomicReference<>(null);
172 this.sourceTable = null;
173 this.executorService = null;
174 this.timeScales = timeScales;
175 }
176
177
178
179
180 public String getHost() {
181 return host;
182 }
183
184
185
186
187 public int getPort() {
188 return port;
189 }
190
191
192
193
194
195 public TimeScales getTimeScales() {
196 return timeScales;
197 }
198
199
200
201
202 public void setTimeout(final int timeout) {
203 this.timeout = timeout;
204 }
205
206
207
208
209
210
211 public void setReconnectParameters(final double delay,
212 final double delayFactor,
213 final int max) {
214 this.reconnectDelay = delay;
215 this.reconnectDelayFactor = delayFactor;
216 this.maxRetries = max;
217 }
218
219
220
221
222
223
224 public void setProxy(final Proxy.Type type, final String proxyHost, final int proxyPort) {
225 try {
226 if (type == Proxy.Type.DIRECT) {
227
228 proxy = Proxy.NO_PROXY;
229 } else {
230
231 final InetAddress hostAddress = InetAddress.getByName(proxyHost);
232 final SocketAddress proxyAddress = new InetSocketAddress(hostAddress, proxyPort);
233 proxy = new Proxy(type, proxyAddress);
234 }
235 } catch (UnknownHostException uhe) {
236 throw new OrekitException(uhe, OrekitMessages.UNKNOWN_HOST, proxyHost);
237 }
238 }
239
240
241
242
243 public Proxy getProxy() {
244 return proxy;
245 }
246
247
248
249
250
251
252
253
254
255
256 public void setFix(final int hour, final int minute, final double second,
257 final double latitude, final double longitude, final double ellAltitude,
258 final double undulation) {
259
260
261 final double latDeg = FastMath.abs(FastMath.toDegrees(latitude));
262 final int dLat = (int) FastMath.floor(latDeg);
263 final double mLat = DEG_TO_MINUTES * (latDeg - dLat);
264 final char cLat = latitude >= 0.0 ? 'N' : 'S';
265
266
267 final double lonDeg = FastMath.abs(FastMath.toDegrees(longitude));
268 final int dLon = (int) FastMath.floor(lonDeg);
269 final double mLon = DEG_TO_MINUTES * (lonDeg - dLon);
270 final char cLon = longitude >= 0.0 ? 'E' : 'W';
271
272
273 final StringBuilder builder = new StringBuilder(82);
274 try (Formatter formatter = new Formatter(builder, Locale.US)) {
275
276
277 final int fixQuality = 1;
278 final int nbSat = 4;
279 final double hdop = 1.0;
280
281
282 formatter.format("$GPGGA,%02d%02d%06.3f,%02d%07.4f,%c,%02d%07.4f,%c,%1d,%02d,%3.1f,%.1f,M,%.1f,M,,",
283 hour, minute, second,
284 dLat, mLat, cLat, dLon, mLon, cLon,
285 fixQuality, nbSat, hdop,
286 ellAltitude, undulation);
287
288
289 byte sum = 0;
290 for (int i = 1; i < builder.length(); ++i) {
291 sum ^= builder.charAt(i);
292 }
293 formatter.format("*%02X", sum);
294
295 }
296 gga.set(builder.toString());
297
298 }
299
300
301
302
303 String getGGA() {
304 return gga.get();
305 }
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320 public void addObserver(final int typeCode, final String mountPoint,
321 final MessageObserver observer) {
322
323
324 observers.add(new ObserverHolder(typeCode, mountPoint, observer));
325
326
327 for (Map.Entry<String, StreamMonitor> entry : monitors.entrySet()) {
328 if (mountPoint == null || mountPoint.equals(entry.getKey())) {
329 entry.getValue().addObserver(typeCode, observer);
330 }
331 }
332
333 }
334
335
336
337
338 public SourceTable getSourceTable() {
339 if (sourceTable == null) {
340 try {
341
342
343 final HttpURLConnection connection = connect("");
344
345 final int responseCode = connection.getResponseCode();
346 if (responseCode == HttpURLConnection.HTTP_UNAUTHORIZED) {
347 throw new OrekitException(OrekitMessages.FAILED_AUTHENTICATION, "caster");
348 } else if (responseCode != HttpURLConnection.HTTP_OK) {
349 throw new OrekitException(OrekitMessages.CONNECTION_ERROR, host, connection.getResponseMessage());
350 }
351
352
353 if (!SOURCETABLE_CONTENT_TYPE.equals(connection.getContentType())) {
354 throw new OrekitException(OrekitMessages.UNEXPECTED_CONTENT_TYPE, connection.getContentType());
355 }
356
357 final SourceTable table = new SourceTable(getHeaderValue(connection, FLAGS_HEADER_KEY));
358
359
360 try (InputStream is = connection.getInputStream();
361 InputStreamReader isr = new InputStreamReader(is, StandardCharsets.UTF_8);
362 BufferedReader br = new BufferedReader(isr)) {
363 int lineNumber = 0;
364 for (String line = br.readLine(); line != null; line = br.readLine()) {
365
366 ++lineNumber;
367 line = line.trim();
368 if (line.length() == 0) {
369 continue;
370 }
371
372 if (line.startsWith(RecordType.CAS.toString())) {
373 table.addCasterRecord(new CasterRecord(line));
374 } else if (line.startsWith(RecordType.NET.toString())) {
375 table.addNetworkRecord(new NetworkRecord(line));
376 } else if (line.startsWith(RecordType.STR.toString())) {
377 table.addDataStreamRecord(new DataStreamRecord(line));
378 } else if (line.startsWith("ENDSOURCETABLE")) {
379
380 break;
381 } else {
382 throw new OrekitException(OrekitMessages.SOURCETABLE_PARSE_ERROR,
383 connection.getURL().getHost(), lineNumber, line);
384 }
385
386 }
387 }
388
389 sourceTable = table;
390 return table;
391
392 } catch (IOException | URISyntaxException e) {
393 throw new OrekitException(e, OrekitMessages.CANNOT_PARSE_SOURCETABLE, host);
394 }
395 }
396
397 return sourceTable;
398
399 }
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418 public void startStreaming(final String mountPoint, final org.orekit.gnss.metric.ntrip.Type type,
419 final boolean requiresNMEA, final boolean ignoreUnknownMessageTypes) {
420
421 if (executorService == null) {
422
423 executorService = Executors.newFixedThreadPool(getSourceTable().getDataStreams().size());
424 }
425
426
427 if (monitors.containsKey(mountPoint)) {
428 throw new OrekitException(OrekitMessages.MOUNPOINT_ALREADY_CONNECTED, mountPoint);
429 }
430
431
432 final StreamMonitor monitor = new StreamMonitor(this, mountPoint, type, requiresNMEA, ignoreUnknownMessageTypes,
433 reconnectDelay, reconnectDelayFactor, maxRetries);
434 monitors.put(mountPoint, monitor);
435
436
437 for (final ObserverHolder observerHolder : observers) {
438 if (observerHolder.mountPoint == null ||
439 observerHolder.mountPoint.equals(mountPoint)) {
440 monitor.addObserver(observerHolder.typeCode, observerHolder.observer);
441 }
442 }
443
444
445 executorService.execute(monitor);
446
447 }
448
449
450
451
452
453
454 public void checkException() {
455
456 for (final Map.Entry<String, StreamMonitor> entry : monitors.entrySet()) {
457 final OrekitException exception = entry.getValue().getException();
458 if (exception != null) {
459 throw exception;
460 }
461 }
462 }
463
464
465
466
467
468
469
470 public void stopStreaming(final int time) {
471
472
473 for (final Map.Entry<String, StreamMonitor> entry : monitors.entrySet()) {
474 entry.getValue().stopMonitoring();
475 }
476
477 try {
478
479 executorService.shutdown();
480 executorService.awaitTermination(time, TimeUnit.MILLISECONDS);
481 } catch (InterruptedException ie) {
482
483 Thread.currentThread().interrupt();
484 }
485
486 checkException();
487
488 }
489
490
491
492
493
494
495
496 HttpURLConnection connect(final String mountPoint)
497 throws IOException, URISyntaxException {
498
499
500 final String scheme = "http";
501 final URL casterURL = new URI(scheme, null, host, port, "/" + mountPoint, null, null).toURL();
502 final HttpURLConnection connection = (HttpURLConnection) casterURL.openConnection(proxy);
503 connection.setConnectTimeout(timeout);
504 connection.setReadTimeout(timeout);
505
506
507 connection.setRequestProperty(HOST_HEADER_KEY, host);
508 connection.setRequestProperty(VERSION_HEADER_KEY, VERSION_HEADER_VALUE);
509 connection.setRequestProperty(USER_AGENT_HEADER_KEY, USER_AGENT_HEADER_VALUE);
510 connection.setRequestProperty(CONNECTION_HEADER_KEY, CONNECTION_HEADER_VALUE);
511
512 return connection;
513
514 }
515
516
517
518
519
520
521 private String getHeaderValue(final URLConnection connection, final String key) {
522 final String value = connection.getHeaderField(key);
523 if (value == null) {
524 throw new OrekitException(OrekitMessages.MISSING_HEADER,
525 connection.getURL().getHost(), key);
526 }
527 return value;
528 }
529
530
531 private static class ObserverHolder {
532
533
534 private final int typeCode;
535
536
537 private final String mountPoint;
538
539
540 private final MessageObserver observer;
541
542
543
544
545
546
547
548 ObserverHolder(final int typeCode, final String mountPoint,
549 final MessageObserver observer) {
550 this.typeCode = typeCode;
551 this.mountPoint = mountPoint;
552 this.observer = observer;
553 }
554
555 }
556
557 }