1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17 package org.orekit.forces.gravity.potential;
18
19 import java.io.IOException;
20 import java.io.InputStream;
21 import java.text.ParseException;
22 import java.util.Arrays;
23 import java.util.Locale;
24
25 import org.hipparchus.util.FastMath;
26 import org.hipparchus.util.Precision;
27 import org.orekit.annotation.DefaultDataContext;
28 import org.orekit.data.DataContext;
29 import org.orekit.data.DataLoader;
30 import org.orekit.errors.OrekitException;
31 import org.orekit.errors.OrekitMessages;
32 import org.orekit.time.AbsoluteDate;
33 import org.orekit.time.DateComponents;
34 import org.orekit.time.TimeComponents;
35 import org.orekit.time.TimeScale;
36
37
38
39
40
41
42
43
44
45
46
47
48 public abstract class PotentialCoefficientsReader implements DataLoader {
49
50
51 private int maxParseDegree;
52
53
54 private int maxParseOrder;
55
56
57 private final String supportedNames;
58
59
60 private final boolean missingCoefficientsAllowed;
61
62
63 private final TimeScale timeScale;
64
65
66 private boolean readComplete;
67
68
69 private double ae;
70
71
72 private double mu;
73
74
75 private Flattener flattener;
76
77
78 private double[] rawC;
79
80
81 private double[] rawS;
82
83
84 private boolean normalized;
85
86
87 private TideSystem tideSystem;
88
89
90
91
92
93
94
95
96
97
98 @DefaultDataContext
99 protected PotentialCoefficientsReader(final String supportedNames,
100 final boolean missingCoefficientsAllowed) {
101 this(supportedNames, missingCoefficientsAllowed,
102 DataContext.getDefault().getTimeScales().getTT());
103 }
104
105
106
107
108
109
110
111
112 protected PotentialCoefficientsReader(final String supportedNames,
113 final boolean missingCoefficientsAllowed,
114 final TimeScale timeScale) {
115 this.supportedNames = supportedNames;
116 this.missingCoefficientsAllowed = missingCoefficientsAllowed;
117 this.maxParseDegree = Integer.MAX_VALUE;
118 this.maxParseOrder = Integer.MAX_VALUE;
119 this.readComplete = false;
120 this.ae = Double.NaN;
121 this.mu = Double.NaN;
122 this.flattener = null;
123 this.rawC = null;
124 this.rawS = null;
125 this.normalized = false;
126 this.tideSystem = TideSystem.UNKNOWN;
127 this.timeScale = timeScale;
128 }
129
130
131
132
133 public String getSupportedNames() {
134 return supportedNames;
135 }
136
137
138
139
140 public boolean missingCoefficientsAllowed() {
141 return missingCoefficientsAllowed;
142 }
143
144
145
146
147
148
149 public void setMaxParseDegree(final int maxParseDegree) {
150 this.maxParseDegree = maxParseDegree;
151 }
152
153
154
155
156
157 public int getMaxParseDegree() {
158 return maxParseDegree;
159 }
160
161
162
163
164
165
166 public void setMaxParseOrder(final int maxParseOrder) {
167 this.maxParseOrder = maxParseOrder;
168 }
169
170
171
172
173
174 public int getMaxParseOrder() {
175 return maxParseOrder;
176 }
177
178
179 public boolean stillAcceptsData() {
180 return !(readComplete &&
181 getMaxAvailableDegree() >= getMaxParseDegree() &&
182 getMaxAvailableOrder() >= getMaxParseOrder());
183 }
184
185
186
187
188 protected void setReadComplete(final boolean readComplete) {
189 this.readComplete = readComplete;
190 }
191
192
193
194
195 protected void setAe(final double ae) {
196 this.ae = ae;
197 }
198
199
200
201
202 protected double getAe() {
203 return ae;
204 }
205
206
207
208
209 protected void setMu(final double mu) {
210 this.mu = mu;
211 }
212
213
214
215
216 protected double getMu() {
217 return mu;
218 }
219
220
221
222
223 protected void setTideSystem(final TideSystem tideSystem) {
224 this.tideSystem = tideSystem;
225 }
226
227
228
229
230 protected TideSystem getTideSystem() {
231 return tideSystem;
232 }
233
234
235
236
237
238
239
240
241
242 protected void setRawCoefficients(final boolean rawNormalized, final Flattener f,
243 final double[] c, final double[] s,
244 final String name) {
245
246 this.flattener = f;
247
248
249 normalized = rawNormalized;
250
251
252
253
254
255
256 setIfUnset(c, flattener.index(0, 0), 1);
257 setIfUnset(s, flattener.index(0, 0), 0);
258
259 if (flattener.getDegree() >= 1) {
260
261
262 setIfUnset(c, flattener.index(1, 0), 0);
263 setIfUnset(s, flattener.index(1, 0), 0);
264 if (flattener.getOrder() >= 1) {
265 setIfUnset(c, flattener.index(1, 1), 0);
266 setIfUnset(s, flattener.index(1, 1), 0);
267 }
268 }
269
270
271 for (int i = 0; i <= flattener.getDegree(); ++i) {
272 for (int j = 0; j <= FastMath.min(i, flattener.getOrder()); ++j) {
273 if (Double.isNaN(c[flattener.index(i, j)])) {
274 throw new OrekitException(OrekitMessages.MISSING_GRAVITY_FIELD_COEFFICIENT_IN_FILE,
275 'C', i, j, name);
276 }
277 }
278 }
279 rawC = c.clone();
280
281
282 for (int i = 0; i <= flattener.getDegree(); ++i) {
283 for (int j = 0; j <= FastMath.min(i, flattener.getOrder()); ++j) {
284 if (Double.isNaN(s[flattener.index(i, j)])) {
285 throw new OrekitException(OrekitMessages.MISSING_GRAVITY_FIELD_COEFFICIENT_IN_FILE,
286 'S', i, j, name);
287 }
288 }
289 }
290 rawS = s.clone();
291
292 }
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310 private boolean setIfUnset(final double[] array, final int i, final double value) {
311 if (array.length > i && (Double.isNaN(array[i]) || Precision.equals(array[i], 0.0, 0))) {
312
313 array[i] = value;
314 return true;
315 } else {
316 return false;
317 }
318 }
319
320
321
322
323
324 public int getMaxAvailableDegree() {
325 return flattener.getDegree();
326 }
327
328
329
330
331
332 public int getMaxAvailableOrder() {
333 return flattener.getOrder();
334 }
335
336
337 public abstract void loadData(InputStream input, String name)
338 throws IOException, ParseException, OrekitException;
339
340
341
342
343
344
345
346
347
348 public abstract RawSphericalHarmonicsProvider getProvider(boolean wantNormalized, int degree, int order);
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363 protected ConstantSphericalHarmonics getBaseProvider(final boolean wantNormalized,
364 final int degree, final int order) {
365
366 if (!readComplete) {
367 throw new OrekitException(OrekitMessages.NO_GRAVITY_FIELD_DATA_LOADED);
368 }
369
370 final Flattener truncatedFlattener = new Flattener(degree, order);
371 return new ConstantSphericalHarmonics(ae, mu, tideSystem, truncatedFlattener,
372 rescale(1.0, wantNormalized, truncatedFlattener, flattener, rawC),
373 rescale(1.0, wantNormalized, truncatedFlattener, flattener, rawS));
374
375 }
376
377
378
379
380
381
382
383 protected static double[] buildFlatArray(final Flattener flattener, final double value) {
384 final double[] array = new double[flattener.arraySize()];
385 Arrays.fill(array, value);
386 return array;
387 }
388
389
390
391
392
393
394
395
396 protected static double parseDouble(final String string) {
397 return Double.parseDouble(string.toUpperCase(Locale.ENGLISH).replace('D', 'E'));
398 }
399
400
401
402
403
404
405
406 protected static double[] buildRow(final int degree, final int order, final double value) {
407 final double[] row = new double[FastMath.min(order, degree) + 1];
408 Arrays.fill(row, value);
409 return row;
410 }
411
412
413
414
415
416
417
418
419
420
421
422 protected void parseCoefficient(final String field, final Flattener f,
423 final double[] array, final int i, final int j,
424 final String cName, final String name) {
425 final int index = f.index(i, j);
426 final double value = parseDouble(field);
427 final double oldValue = array[index];
428 if (Double.isNaN(oldValue) || Precision.equals(oldValue, 0.0, 0)) {
429
430 array[index] = value;
431 } else {
432 throw new OrekitException(OrekitMessages.DUPLICATED_GRAVITY_FIELD_COEFFICIENT_IN_FILE,
433 name, i, j, name);
434 }
435 }
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450 protected double[] rescale(final double scale, final boolean wantNormalized, final Flattener rescaledFlattener,
451 final Flattener originalFlattener, final double[] original) {
452
453 if (rescaledFlattener.getDegree() > originalFlattener.getDegree()) {
454 throw new OrekitException(OrekitMessages.TOO_LARGE_DEGREE_FOR_GRAVITY_FIELD,
455 rescaledFlattener.getDegree(), flattener.getDegree());
456 }
457
458 if (rescaledFlattener.getOrder() > originalFlattener.getOrder()) {
459 throw new OrekitException(OrekitMessages.TOO_LARGE_ORDER_FOR_GRAVITY_FIELD,
460 rescaledFlattener.getOrder(), flattener.getOrder());
461 }
462
463
464 final FactorsGenerator generator;
465 if (wantNormalized == normalized) {
466
467 generator = (n, m) -> scale;
468 } else {
469
470 final double[][] unnormalizationFactors =
471 GravityFieldFactory.getUnnormalizationFactors(rescaledFlattener.getDegree(),
472 rescaledFlattener.getOrder());
473 generator = wantNormalized ?
474 (n, m) -> scale / unnormalizationFactors[n][m] :
475 (n, m) -> scale * unnormalizationFactors[n][m];
476 }
477
478
479 final double[] rescaled = buildFlatArray(rescaledFlattener, 0.0);
480 for (int n = 0; n <= rescaledFlattener.getDegree(); ++n) {
481 for (int m = 0; m <= FastMath.min(n, rescaledFlattener.getOrder()); ++m) {
482 final int rescaledndex = rescaledFlattener.index(n, m);
483 final int originalndex = originalFlattener.index(n, m);
484 rescaled[rescaledndex] = original[originalndex] * generator.factor(n, m);
485 }
486 }
487
488 return rescaled;
489
490 }
491
492
493
494
495
496
497
498
499
500
501
502
503
504 protected TimeDependentHarmonic[] rescale(final boolean wantNormalized, final Flattener rescaledFlattener,
505 final Flattener originalFlattener, final TimeDependentHarmonic[] original) {
506
507 if (rescaledFlattener.getDegree() > originalFlattener.getDegree()) {
508 throw new OrekitException(OrekitMessages.TOO_LARGE_DEGREE_FOR_GRAVITY_FIELD,
509 rescaledFlattener.getDegree(), flattener.getDegree());
510 }
511
512 if (rescaledFlattener.getOrder() > originalFlattener.getOrder()) {
513 throw new OrekitException(OrekitMessages.TOO_LARGE_ORDER_FOR_GRAVITY_FIELD,
514 rescaledFlattener.getOrder(), flattener.getOrder());
515 }
516
517
518 final FactorsGenerator generator;
519 if (wantNormalized == normalized) {
520
521 generator = (n, m) -> 1.0;
522 } else {
523
524 final double[][] unnormalizationFactors =
525 GravityFieldFactory.getUnnormalizationFactors(rescaledFlattener.getDegree(),
526 rescaledFlattener.getOrder());
527 generator = wantNormalized ?
528 (n, m) -> 1.0 / unnormalizationFactors[n][m] :
529 (n, m) -> unnormalizationFactors[n][m];
530 }
531
532
533 final TimeDependentHarmonic[] rescaled = new TimeDependentHarmonic[rescaledFlattener.arraySize()];
534 for (int n = 0; n <= rescaledFlattener.getDegree(); ++n) {
535 for (int m = 0; m <= FastMath.min(n, rescaledFlattener.getOrder()); ++m) {
536 final int originalndex = originalFlattener.index(n, m);
537 if (original[originalndex] != null) {
538 final int rescaledndex = rescaledFlattener.index(n, m);
539 final double factor = generator.factor(n, m);
540 rescaled[rescaledndex] = new TimeDependentHarmonic(factor, original[originalndex]);
541 }
542 }
543 }
544
545 return rescaled;
546
547 }
548
549
550
551
552
553
554
555 protected AbsoluteDate toDate(final DateComponents components) {
556 return toDate(components, TimeComponents.H12);
557 }
558
559
560
561
562
563
564
565
566
567 protected AbsoluteDate toDate(final DateComponents dc, final TimeComponents tc) {
568 return new AbsoluteDate(dc, tc, timeScale);
569 }
570
571
572
573
574 private interface FactorsGenerator {
575
576
577
578
579
580 double factor(int n, int m);
581 }
582
583 }