OEMParser.java

  1. /* Copyright 2002-2013 CS Systèmes d'Information
  2.  * Licensed to CS Systèmes d'Information (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. package org.orekit.files.ccsds;

  19. import java.io.BufferedReader;
  20. import java.io.IOException;
  21. import java.io.InputStream;
  22. import java.io.InputStreamReader;
  23. import java.util.ArrayList;
  24. import java.util.List;
  25. import java.util.Scanner;

  27. import org.apache.commons.math3.exception.util.DummyLocalizable;
  28. import org.apache.commons.math3.geometry.euclidean.threed.Vector3D;
  29. import org.apache.commons.math3.linear.MatrixUtils;
  30. import org.apache.commons.math3.linear.RealMatrix;
  31. import org.orekit.errors.OrekitException;
  32. import org.orekit.errors.OrekitMessages;
  33. import org.orekit.files.general.OrbitFileParser;
  34. import org.orekit.frames.Frame;
  35. import org.orekit.frames.LOFType;
  36. import org.orekit.orbits.CartesianOrbit;
  37. import org.orekit.time.AbsoluteDate;
  38. import org.orekit.utils.IERSConventions;
  39. import org.orekit.utils.PVCoordinates;

  41. /**
  42.  * A parser for the CCSDS OEM (Orbit Ephemeris Message).
  43.  * @author sports
  44.  * @since 6.1
  45.  */
  46. public class OEMParser extends ODMParser implements OrbitFileParser {

  48.     /** Simple constructor.
  49.      * <p>
  50.      * This class is immutable, and hence thread safe. When parts
  51.      * must be changed, such as reference date for Mission Elapsed Time or
  52.      * Mission Relative Time time systems, or the gravitational coefficient or
  53.      * the IERS conventions, the various {@code withXxx} methods must be called,
  54.      * which create a new immutable instance with the new parameters. This
  55.      * is a combination of the <a href="">builder design pattern</a> and
  56.      * a <a href="http://en.wikipedia.org/wiki/Fluent_interface">fluent
  57.      * interface</a>.
  58.      * </p>
  59.      * <p>
  60.      * The initial date for Mission Elapsed Time and Mission Relative Time time systems is not set here.
  61.      * If such time systems are used, it must be initialized before parsing by calling {@link
  62.      * #withMissionReferenceDate(AbsoluteDate)}.
  63.      * </p>
  64.      * <p>
  65.      * The gravitational coefficient is not set here. If it is needed in order
  66.      * to parse Cartesian orbits where the value is not set in the CCSDS file, it must
  67.      * be initialized before parsing by calling {@link #withMu(double)}.
  68.      * </p>
  69.      * <p>
  70.      * The IERS conventions to use is not set here. If it is needed in order to
  71.      * parse some reference frames or UT1 time scale, it must be initialized before
  72.      * parsing by calling {@link #withConventions(IERSConventions)}.
  73.      * </p>
  74.      */
  75.     public OEMParser() {
  76.         this(AbsoluteDate.FUTURE_INFINITY, Double.NaN, null, true, 0, 0, "");
  77.     }

  79.     /** Complete constructor.
  80.      * @param missionReferenceDate reference date for Mission Elapsed Time or Mission Relative Time time systems
  81.      * @param mu gravitational coefficient
  82.      * @param conventions IERS Conventions
  83.      * @param simpleEOP if true, tidal effects are ignored when interpolating EOP
  84.      * @param launchYear launch year for TLEs
  85.      * @param launchNumber launch number for TLEs
  86.      * @param launchPiece piece of launch (from "A" to "ZZZ") for TLEs
  87.      */
  88.     private OEMParser(final AbsoluteDate missionReferenceDate, final double mu,
  89.                       final IERSConventions conventions, final boolean simpleEOP,
  90.                       final int launchYear, final int launchNumber, final String launchPiece) {
  91.         super(missionReferenceDate, mu, conventions, simpleEOP, launchYear, launchNumber, launchPiece);
  92.     }

  94.     /** {@inheritDoc} */
  95.     public OEMParser withMissionReferenceDate(final AbsoluteDate newMissionReferenceDate) {
  96.         return new OEMParser(newMissionReferenceDate, getMu(), getConventions(), isSimpleEOP(),
  97.                              getLaunchYear(), getLaunchNumber(), getLaunchPiece());
  98.     }

  100.     /** {@inheritDoc} */
  101.     public OEMParser withMu(final double newMu) {
  102.         return new OEMParser(getMissionReferenceDate(), newMu, getConventions(), isSimpleEOP(),
  103.                              getLaunchYear(), getLaunchNumber(), getLaunchPiece());
  104.     }

  106.     /** {@inheritDoc} */
  107.     public OEMParser withConventions(final IERSConventions newConventions) {
  108.         return new OEMParser(getMissionReferenceDate(), getMu(), newConventions, isSimpleEOP(),
  109.                              getLaunchYear(), getLaunchNumber(), getLaunchPiece());
  110.     }

  112.     /** {@inheritDoc} */
  113.     public OEMParser withSimpleEOP(final boolean newSimpleEOP) {
  114.         return new OEMParser(getMissionReferenceDate(), getMu(), getConventions(), newSimpleEOP,
  115.                              getLaunchYear(), getLaunchNumber(), getLaunchPiece());
  116.     }

  118.     /** {@inheritDoc} */
  119.     public OEMParser withInternationalDesignator(final int newLaunchYear,
  120.                                                  final int newLaunchNumber,
  121.                                                  final String newLaunchPiece) {
  122.         return new OEMParser(getMissionReferenceDate(), getMu(), getConventions(), isSimpleEOP(),
  123.                              newLaunchYear, newLaunchNumber, newLaunchPiece);
  124.     }

  126.     /** {@inheritDoc} */
  127.     @Override
  128.     public OEMFile parse(final String fileName) throws OrekitException {
  129.         return (OEMFile) super.parse(fileName);
  130.     }

  132.     /** {@inheritDoc} */
  133.     public OEMFile parse(final InputStream stream, final String fileName) throws OrekitException {

  135.         try {

  137.             final BufferedReader reader = new BufferedReader(new InputStreamReader(stream, "UTF-8"));
  138.             // initialize internal data structures
  139.             final ParseInfo pi = new ParseInfo();
  140.             pi.fileName = fileName;
  141.             final OEMFile file = pi.file;

  143.             // set the additional data that has been configured prior the parsing by the user.
  144.             pi.file.setMissionReferenceDate(getMissionReferenceDate());
  145.             pi.file.setMuSet(getMu());
  146.             pi.file.setConventions(getConventions());

  148.             for (String line = reader.readLine(); line != null; line = reader.readLine()) {
  149.                 ++pi.lineNumber;
  150.                 if (line.trim().length() == 0) {
  151.                     continue;
  152.                 }
  153.                 pi.keyValue = new KeyValue(line, pi.lineNumber, pi.fileName);
  154.                 if (pi.keyValue.getKeyword() == null) {
  155.                     throw new OrekitException(OrekitMessages.CCSDS_UNEXPECTED_KEYWORD, pi.lineNumber, pi.fileName, line);
  156.                 }
  157.                 switch (pi.keyValue.getKeyword()) {
  158.                 case CCSDS_OEM_VERS:
  159.                     file.setFormatVersion(pi.keyValue.getDoubleValue());
  160.                     break;

  162.                 case META_START:
  163.                     file.addEphemeridesBlock();
  164.                     pi.lastEphemeridesBlock = file.getEphemeridesBlocks().get(file.getEphemeridesBlocks().size() - 1);
  165.                     pi.lastEphemeridesBlock.getMetaData().setLaunchYear(getLaunchYear());
  166.                     pi.lastEphemeridesBlock.getMetaData().setLaunchNumber(getLaunchNumber());
  167.                     pi.lastEphemeridesBlock.getMetaData().setLaunchPiece(getLaunchPiece());
  168.                     break;

  170.                 case START_TIME:
  171.                     pi.lastEphemeridesBlock.setStartTime(parseDate(pi.keyValue.getValue(),
  172.                                                                    pi.lastEphemeridesBlock.getMetaData().getTimeSystem()));
  173.                     break;

  175.                 case USEABLE_START_TIME:
  176.                     pi.lastEphemeridesBlock.setUseableStartTime(parseDate(pi.keyValue.getValue(),
  177.                                                                           pi.lastEphemeridesBlock.getMetaData().getTimeSystem()));
  178.                     break;

  180.                 case USEABLE_STOP_TIME:
  181.                     pi.lastEphemeridesBlock.setUseableStopTime(parseDate(pi.keyValue.getValue(), pi.lastEphemeridesBlock.getMetaData().getTimeSystem()));
  182.                     break;

  184.                 case STOP_TIME:
  185.                     pi.lastEphemeridesBlock.setStopTime(parseDate(pi.keyValue.getValue(), pi.lastEphemeridesBlock.getMetaData().getTimeSystem()));
  186.                     break;

  188.                 case INTERPOLATION:
  189.                     pi.lastEphemeridesBlock.setInterpolationMethod(pi.keyValue.getValue());
  190.                     break;

  192.                 case INTERPOLATION_DEGREE:
  193.                     pi.lastEphemeridesBlock.setInterpolationDegree(Integer .parseInt(pi.keyValue.getValue()));
  194.                     break;

  196.                 case META_STOP:
  197.                     file.setMuUsed();
  198.                     parseEphemeridesDataLines(reader, pi);
  199.                     break;

  201.                 case COVARIANCE_START:
  202.                     parseCovarianceDataLines(reader, pi);
  203.                     break;

  205.                 default:
  206.                     boolean parsed = false;
  207.                     parsed = parsed || parseComment(pi.keyValue, pi.commentTmp);
  208.                     parsed = parsed || parseHeaderEntry(pi.keyValue, file, pi.commentTmp);
  209.                     if (pi.lastEphemeridesBlock != null) {
  210.                         parsed = parsed || parseMetaDataEntry(pi.keyValue,
  211.                                                               pi.lastEphemeridesBlock.getMetaData(), pi.commentTmp);
  212.                     }
  213.                     if (!parsed) {
  214.                         throw new OrekitException(OrekitMessages.CCSDS_UNEXPECTED_KEYWORD, pi.lineNumber, pi.fileName, line);
  215.                     }
  216.                 }
  217.             }
  218.             file.checkTimeSystems();
  219.             return file;
  220.         } catch (IOException ioe) {
  221.             throw new OrekitException(ioe, new DummyLocalizable(ioe.getMessage()));
  222.         }
  223.     }

  225.     /**
  226.      * Parse an ephemeris data line and add its content to the ephemerides
  227.      * block.
  228.      *
  229.      * @param reader the reader
  230.      * @param pi the parser info
  231.      * @exception IOException if an error occurs while reading from the stream
  232.      * @exception OrekitException if a date cannot be parsed
  233.      */
  234.     private void parseEphemeridesDataLines(final BufferedReader reader,  final ParseInfo pi)
  235.         throws OrekitException, IOException {

  237.         for (String line = reader.readLine(); line != null; line = reader.readLine()) {

  239.             ++pi.lineNumber;
  240.             if (line.trim().length() > 0) {
  241.                 pi.keyValue = new KeyValue(line, pi.lineNumber, pi.fileName);
  242.                 if (pi.keyValue.getKeyword() == null) {
  243.                     try {
  244.                         final Scanner sc = new Scanner(line);
  245.                         final AbsoluteDate date = parseDate(sc.next(), pi.lastEphemeridesBlock.getMetaData().getTimeSystem());
  246.                         final Vector3D position = new Vector3D(Double.parseDouble(sc.next()) * 1000,
  247.                                                                Double.parseDouble(sc.next()) * 1000,
  248.                                                                Double.parseDouble(sc.next()) * 1000);
  249.                         final Vector3D velocity = new Vector3D(Double.parseDouble(sc.next()) * 1000,
  250.                                                                Double.parseDouble(sc.next()) * 1000,
  251.                                                                Double.parseDouble(sc.next()) * 1000);
  252.                         final CartesianOrbit orbit =
  253.                                 new CartesianOrbit(new PVCoordinates(position, velocity),
  254.                                                    pi.lastEphemeridesBlock.getMetaData().getFrame(),
  255.                                                    date, pi.file.getMuUsed());
  256.                         Vector3D acceleration = null;
  257.                         if (sc.hasNext()) {
  258.                             acceleration = new Vector3D(Double.parseDouble(sc.next()) * 1000,
  259.                                                         Double.parseDouble(sc.next()) * 1000,
  260.                                                         Double.parseDouble(sc.next()) * 1000);
  261.                         }
  262.                         final OEMFile.EphemeridesDataLine epDataLine =
  263.                                 new OEMFile.EphemeridesDataLine(orbit, acceleration);
  264.                         pi.lastEphemeridesBlock.getEphemeridesDataLines().add(epDataLine);
  265.                     } catch (NumberFormatException nfe) {
  266.                         throw new OrekitException(OrekitMessages.UNABLE_TO_PARSE_LINE_IN_FILE,
  267.                                                   pi.lineNumber, pi.fileName, line);
  268.                     }
  269.                 } else {
  270.                     switch (pi.keyValue.getKeyword()) {
  271.                     case META_START:
  272.                         pi.lastEphemeridesBlock.setEphemeridesDataLinesComment(pi.commentTmp);
  273.                         pi.commentTmp.clear();
  274.                         pi.lineNumber--;
  275.                         reader.reset();
  276.                         return;
  277.                     case COVARIANCE_START:
  278.                         pi.lastEphemeridesBlock.setEphemeridesDataLinesComment(pi.commentTmp);
  279.                         pi.commentTmp.clear();
  280.                         pi.lineNumber--;
  281.                         reader.reset();
  282.                         return;
  283.                     case COMMENT:
  284.                         pi.commentTmp.add(pi.keyValue.getValue());
  285.                         break;
  286.                     default :
  287.                         throw new OrekitException(OrekitMessages.CCSDS_UNEXPECTED_KEYWORD, pi.lineNumber, pi.fileName, line);
  288.                     }
  289.                 }
  290.             }
  291.             reader.mark(300);

  293.         }
  294.     }

  296.     /**
  297.      * Parse the covariance data lines, create a set of CovarianceMatrix objects
  298.      * and add them in the covarianceMatrices list of the ephemerides block.
  299.      *
  300.      * @param reader the reader
  301.      * @param pi the parser info
  302.      * @throws IOException if an error occurs while reading from the stream
  303.      * @throws OrekitException if the frame cannot be retrieved
  304.      */
  305.     private void parseCovarianceDataLines(final BufferedReader reader, final ParseInfo pi)
  306.         throws IOException, OrekitException  {
  307.         int i = 0;
  308.         for (String line = reader.readLine(); line != null; line = reader.readLine()) {

  310.             ++pi.lineNumber;
  311.             if (line.trim().length() == 0) {
  312.                 continue;
  313.             }
  314.             pi.keyValue = new KeyValue(line, pi.lineNumber, pi.fileName);
  315.             if (pi.keyValue.getKeyword() == null) {
  316.                 final Scanner sc = new Scanner(line);
  317.                 for (int j = 0; j < i + 1; j++) {
  318.                     try {
  319.                         pi.lastMatrix.addToEntry(i, j, Double.parseDouble(sc.next()));
  320.                     } catch (NumberFormatException nfe) {
  321.                         throw new OrekitException(OrekitMessages.UNABLE_TO_PARSE_LINE_IN_FILE,
  322.                                                   pi.lineNumber, pi.fileName, line);
  323.                     }
  324.                     if (j != i) {
  325.                         pi.lastMatrix.addToEntry(j, i, pi.lastMatrix.getEntry(i, j));
  326.                     }
  327.                 }
  328.                 if (i == 5) {
  329.                     final OEMFile.CovarianceMatrix cm =
  330.                             new OEMFile.CovarianceMatrix(pi.epoch, pi.covRefLofType, pi.covRefFrame, pi.lastMatrix);
  331.                     pi.lastEphemeridesBlock.getCovarianceMatrices().add(cm);
  332.                 }
  333.                 i++;
  334.             } else {
  335.                 switch (pi.keyValue.getKeyword()) {
  336.                 case EPOCH :
  337.                     i                = 0;
  338.                     pi.covRefLofType = null;
  339.                     pi.covRefFrame   = null;
  340.                     pi.lastMatrix    = MatrixUtils.createRealMatrix(6, 6);
  341.                     pi.epoch         = parseDate(pi.keyValue.getValue(), pi.lastEphemeridesBlock.getMetaData().getTimeSystem());
  342.                     break;
  343.                 case COV_REF_FRAME :
  344.                     final CCSDSFrame frame = parseCCSDSFrame(pi.keyValue.getValue());
  345.                     if (frame.isLof()) {
  346.                         pi.covRefLofType = frame.getLofType();
  347.                         pi.covRefFrame   = null;
  348.                     } else {
  349.                         pi.covRefLofType = null;
  350.                         pi.covRefFrame   = frame.getFrame(getConventions(), isSimpleEOP());
  351.                     }
  352.                     break;
  353.                 case COVARIANCE_STOP :
  354.                     return;
  355.                 default :
  356.                     throw new OrekitException(OrekitMessages.CCSDS_UNEXPECTED_KEYWORD, pi.lineNumber, pi.fileName, line);
  357.                 }
  358.             }
  359.         }
  360.     }

  362.     /** Private class used to stock OEM parsing info.
  363.      * @author sports
  364.      */
  365.     private static class ParseInfo {

  367.         /** Ephemerides block being parsed. */
  368.         private OEMFile.EphemeridesBlock lastEphemeridesBlock;

  370.         /** Name of the file. */
  371.         private String fileName;

  373.         /** Current line number. */
  374.         private int lineNumber;

  376.         /** OEM file being read. */
  377.         private OEMFile file;

  379.         /** Key value of the line being read. */
  380.         private KeyValue keyValue;

  382.         /** Stored epoch. */
  383.         private AbsoluteDate epoch;

  385.         /** Covariance reference type of Local Orbital Frame. */
  386.         private LOFType covRefLofType;

  388.         /** Covariance reference frame. */
  389.         private Frame covRefFrame;
  390.         /** Stored matrix. */
  391.         private RealMatrix lastMatrix;

  393.         /** Stored comments. */
  394.         private List<String> commentTmp;

  396.         /** Create a new {@link ParseInfo} object. */
  397.         protected ParseInfo() {
  398.             lineNumber = 0;
  399.             file = new OEMFile();
  400.             commentTmp = new ArrayList<String>();
  401.         }
  402.     }
  403. }
Created with JaCoCo 0.6.3.201306030806