1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18 package org.orekit.files.ccsds.ndm.adm.acm;
19
20 import java.io.IOException;
21 import java.util.List;
22
23 import org.hipparchus.linear.DiagonalMatrix;
24 import org.orekit.files.ccsds.definitions.TimeConverter;
25 import org.orekit.files.ccsds.section.AbstractWriter;
26 import org.orekit.files.ccsds.utils.FileFormat;
27 import org.orekit.files.ccsds.utils.generation.Generator;
28 import org.orekit.utils.units.Unit;
29
30
31
32
33
34 class AttitudeCovarianceHistoryWriter extends AbstractWriter {
35
36
37 private final AttitudeCovarianceHistory history;
38
39
40 private final TimeConverter timeConverter;
41
42
43
44
45
46 AttitudeCovarianceHistoryWriter(final AttitudeCovarianceHistory covarianceHistory,
47 final TimeConverter timeConverter) {
48 super(AcmDataSubStructureKey.cov.name(), AcmDataSubStructureKey.COV.name());
49 this.history = covarianceHistory;
50 this.timeConverter = timeConverter;
51 }
52
53
54 @Override
55 protected void writeContent(final Generator generator) throws IOException {
56
57
58 final AttitudeCovarianceHistoryMetadata metadata = history.getMetadata();
59 generator.writeComments(metadata.getComments());
60
61
62 generator.writeEntry(AttitudeCovarianceHistoryMetadataKey.COV_ID.name(), metadata.getCovID(), null, false);
63 generator.writeEntry(AttitudeCovarianceHistoryMetadataKey.COV_PREV_ID.name(), metadata.getCovPrevID(), null, false);
64 generator.writeEntry(AttitudeCovarianceHistoryMetadataKey.COV_BASIS.name(), metadata.getCovBasis(), null, false);
65 generator.writeEntry(AttitudeCovarianceHistoryMetadataKey.COV_BASIS_ID.name(), metadata.getCovBasisID(), null, false);
66
67
68 if (metadata.getCovReferenceFrame() != null) {
69 generator.writeEntry(AttitudeCovarianceHistoryMetadataKey.COV_REF_FRAME.name(), metadata.getCovReferenceFrame().getName(), null, false);
70 }
71
72
73 generator.writeEntry(AttitudeCovarianceHistoryMetadataKey.COV_TYPE.name(), metadata.getCovType(), false);
74
75
76 final List<Unit> units = metadata.getCovType().getUnits();
77 for (final AttitudeCovariance covariance : history.getCovariances()) {
78 final DiagonalMatrix matrix = covariance.getMatrix();
79 final StringBuilder line = new StringBuilder();
80 line.append(generator.dateToString(timeConverter, covariance.getDate()));
81 for (int k = 0; k < units.size(); ++k) {
82 line.append(' ');
83 line.append(generator.doubleToString(units.get(k).fromSI(matrix.getEntry(k, k))));
84 }
85 if (generator.getFormat() == FileFormat.XML) {
86 generator.writeEntry(Acm.COV_LINE, line.toString(), null, true);
87 } else {
88 generator.writeRawData(line);
89 generator.newLine();
90 }
91
92 }
93
94 }
95
96 }