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