1   /* Copyright 2002-2024 Luc Maisonobe
2    * Licensed to CS GROUP (CS) under one or more
3    * contributor license agreements.  See the NOTICE file distributed with
4    * this work for additional information regarding copyright ownership.
5    * CS licenses this file to You under the Apache License, Version 2.0
6    * (the "License"); you may not use this file except in compliance with
7    * the License.  You may obtain a copy of the License at
8    *
9    *   http://www.apache.org/licenses/LICENSE-2.0
10   *
11   * Unless required by applicable law or agreed to in writing, software
12   * distributed under the License is distributed on an "AS IS" BASIS,
13   * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14   * See the License for the specific language governing permissions and
15   * limitations under the License.
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  /** Writer for attitude state history data.
32   * @author Luc Maisonobe
33   * @since 12.0
34   */
35  class AttitudeStateHistoryWriter extends AbstractWriter {
36  
37      /** Attitude state history block. */
38      private final AttitudeStateHistory history;
39  
40      /** Converter for dates. */
41      private final TimeConverter timeConverter;
42  
43      /** Create a writer.
44       * @param attitudeStateHistory trajectory state history to write
45       * @param timeConverter converter for dates
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      /** {@inheritDoc} */
55      @Override
56      protected void writeContent(final Generator generator) throws IOException {
57  
58          // trajectory state history block
59          final AttitudeStateHistoryMetadata metadata = history.getMetadata();
60          generator.writeComments(metadata.getComments());
61  
62          // identifiers
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          // references
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          // types
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          // data
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 }