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.Collections;
22 import java.util.List;
23
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 AttitudeStateHistoryWriter extends AbstractWriter {
35
36
37 private final AttitudeStateHistory history;
38
39
40 private final TimeConverter timeConverter;
41
42
43
44
45
46 AttitudeStateHistoryWriter(final AttitudeStateHistory attitudeStateHistory,
47 final TimeConverter timeConverter) {
48 super(AcmDataSubStructureKey.att.name(), AcmDataSubStructureKey.ATT.name());
49 this.history = attitudeStateHistory;
50 this.timeConverter = timeConverter;
51 }
52
53
54 @Override
55 protected void writeContent(final Generator generator) throws IOException {
56
57
58 final AttitudeStateHistoryMetadata metadata = history.getMetadata();
59 generator.writeComments(metadata.getComments());
60
61
62 generator.writeEntry(AttitudeStateHistoryMetadataKey.ATT_ID.name(), metadata.getAttID(), null, false);
63 generator.writeEntry(AttitudeStateHistoryMetadataKey.ATT_PREV_ID.name(), metadata.getAttPrevID(), null, false);
64 generator.writeEntry(AttitudeStateHistoryMetadataKey.ATT_BASIS.name(), metadata.getAttBasis(), null, false);
65 generator.writeEntry(AttitudeStateHistoryMetadataKey.ATT_BASIS_ID.name(), metadata.getAttBasisID(), null, false);
66
67
68 generator.writeEntry(AttitudeStateHistoryMetadataKey.REF_FRAME_A.name(), metadata.getEndpoints().getFrameA().getName(), null, true);
69 generator.writeEntry(AttitudeStateHistoryMetadataKey.REF_FRAME_B.name(), metadata.getEndpoints().getFrameB().getName(), null, true);
70
71
72 if (metadata.getAttitudeType() == AttitudeElementsType.EULER_ANGLES) {
73 generator.writeEntry(AttitudeStateHistoryMetadataKey.EULER_ROT_SEQ.name(), metadata.getEulerRotSeq(), true);
74 }
75 generator.writeEntry(AttitudeStateHistoryMetadataKey.NUMBER_STATES.name(), metadata.getNbStates(), true);
76 generator.writeEntry(AttitudeStateHistoryMetadataKey.ATT_TYPE.name(), metadata.getAttitudeType(), true);
77 if (metadata.getRateType() != null) {
78 generator.writeEntry(AttitudeStateHistoryMetadataKey.RATE_TYPE.name(), metadata.getRateType(), true);
79 }
80
81
82 final List<Unit> attUnits = metadata.getAttitudeType().getUnits();
83 final List<Unit> rateUnits = metadata.getRateType() == null ?
84 Collections.emptyList() : metadata.getRateType().getUnits();
85 for (final AttitudeState state : history.getAttitudeStates()) {
86 final double[] elements = state.getElements();
87 final StringBuilder line = new StringBuilder();
88 line.append(generator.dateToString(timeConverter, state.getDate()));
89 for (int i = 0; i < attUnits.size(); ++i) {
90 line.append(' ');
91 line.append(generator.doubleToString(attUnits.get(i).fromSI(elements[i])));
92 }
93 for (int i = 0; i < rateUnits.size(); ++i) {
94 line.append(' ');
95 line.append(generator.doubleToString(rateUnits.get(i).fromSI(elements[attUnits.size() + i])));
96 }
97 if (generator.getFormat() == FileFormat.XML) {
98 generator.writeEntry(Acm.ATT_LINE, line.toString(), null, true);
99 } else {
100 generator.writeRawData(line);
101 generator.newLine();
102 }
103 }
104
105 }
106
107 }