1   /* Contributed in the public domain.
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  package org.orekit.propagation.analytical;
18  
19  import java.util.Collection;
20  import java.util.NavigableMap;
21  
22  import org.hipparchus.CalculusFieldElement;
23  import org.hipparchus.geometry.euclidean.threed.FieldRotation;
24  import org.hipparchus.geometry.euclidean.threed.Rotation;
25  import org.hipparchus.geometry.euclidean.threed.Vector3D;
26  import org.orekit.attitudes.Attitude;
27  import org.orekit.attitudes.AttitudeProvider;
28  import org.orekit.attitudes.FieldAttitude;
29  import org.orekit.errors.OrekitException;
30  import org.orekit.errors.OrekitMessages;
31  import org.orekit.frames.Frame;
32  import org.orekit.orbits.Orbit;
33  import org.orekit.propagation.BoundedPropagator;
34  import org.orekit.propagation.SpacecraftState;
35  import org.orekit.time.AbsoluteDate;
36  import org.orekit.time.FieldAbsoluteDate;
37  import org.orekit.utils.FieldPVCoordinatesProvider;
38  import org.orekit.utils.PVCoordinatesProvider;
39  import org.orekit.utils.TimeSpanMap;
40  import org.orekit.utils.TimeStampedPVCoordinates;
41  
42  /**
43   * A {@link BoundedPropagator} that covers a larger time span from several constituent
44   * propagators that cover shorter time spans.
45   *
46   * @author Evan Ward
47   * @see #AggregateBoundedPropagator(Collection)
48   * @since 9.0
49   */
50  public class AggregateBoundedPropagator extends AbstractAnalyticalPropagator
51          implements BoundedPropagator {
52  
53      /** Constituent propagators. */
54      private final TimeSpanMap<BoundedPropagator> map;
55  
56      /** Minimum date for {@link #getMinDate()}. */
57      private final AbsoluteDate min;
58      /** Maximum date for {@link #getMaxDate()}. */
59      private final AbsoluteDate max;
60  
61      /**
62       * Create a propagator by concatenating several {@link BoundedPropagator}s.
63       *
64       * @param propagators that provide the backing data for this instance. There must be
65       *                    at least one propagator in the collection. If there are gaps
66       *                    between the {@link BoundedPropagator#getMaxDate()} of one
67       *                    propagator and the {@link BoundedPropagator#getMinDate()} of the
68       *                    next propagator an exception may be thrown by any method of this
69       *                    class at any time. If there are overlaps between the {@link
70       *                    BoundedPropagator#getMaxDate()} of one propagator and the {@link
71       *                    BoundedPropagator#getMinDate()} of the next propagator then the
72       *                    propagator with the latest {@link BoundedPropagator#getMinDate()}
73       *                    is used.
74       */
75      public AggregateBoundedPropagator(final Collection<? extends BoundedPropagator> propagators) {
76          super(null);
77          map = new TimeSpanMap<>(null);
78          propagators.forEach(p -> map.addValidAfter(p, p.getMinDate(), false));
79          setAttitudeProvider(new AggregateAttitudeProvider());
80          this.min = map.getFirstNonNullSpan().getData().getMinDate();
81          this.max = map.getLastNonNullSpan().getData().getMaxDate();
82          super.resetInitialState(getInitialState());
83      }
84  
85      /**
86       * Create a propagator from several constituent propagators.
87       *
88       * @param propagators that provide the backing data for this instance. Each
89       *                    propagator is used from the date of it's key in the
90       *                    map until the date of the next key. The first
91       *                    propagator is also used before the first key and the
92       *                    last propagator after the last key.
93       * @param min         the value for {@link #getMinDate()}.
94       * @param max         the value for {@link #getMaxDate()}.
95       */
96      public AggregateBoundedPropagator(final NavigableMap<AbsoluteDate, ? extends BoundedPropagator> propagators,
97                                        final AbsoluteDate min, final AbsoluteDate max) {
98          super(null);
99          map = new TimeSpanMap<>(null);
100         propagators.forEach((d, p) -> map.addValidAfter(p, p.getMinDate(), false));
101         setAttitudeProvider(new AggregateAttitudeProvider());
102         this.min = min;
103         this.max = max;
104         super.resetInitialState(getInitialState());
105     }
106 
107     /** Get the propagators map.
108      * @return propagators map
109      * @since 12.1
110      */
111     public TimeSpanMap<BoundedPropagator> getPropagatorsMap() {
112         return map;
113     }
114 
115     @Override
116     public SpacecraftState basicPropagate(final AbsoluteDate date) {
117         // #589 override this method for a performance benefit,
118         // getPropagator(date).propagate(date) is only called once
119 
120         // do propagation
121         final SpacecraftState state = getPropagator(date).propagate(date);
122 
123         // evaluate attitude
124         final Attitude attitude =
125                 getAttitudeProvider().getAttitude(this, date, state.getFrame());
126 
127         // build raw state
128         if (state.isOrbitDefined()) {
129             return new SpacecraftState(
130                     state.getOrbit(), attitude, state.getMass(),
131                     state.getAdditionalDataValues(), state.getAdditionalStatesDerivatives());
132         } else {
133             return new SpacecraftState(
134                     state.getAbsPVA(), attitude, state.getMass(),
135                     state.getAdditionalDataValues(), state.getAdditionalStatesDerivatives());
136         }
137     }
138 
139     @Override
140     public TimeStampedPVCoordinates getPVCoordinates(final AbsoluteDate date,
141                                                      final Frame frame) {
142         return getPropagator(date).getPVCoordinates(date, frame);
143     }
144 
145     @Override
146     public Vector3D getPosition(final AbsoluteDate date, final Frame frame) {
147         return getPropagator(date).propagate(date).getPosition(frame);
148     }
149 
150     @Override
151     public Orbit propagateOrbit(final AbsoluteDate date) {
152         return getPropagator(date).propagate(date).getOrbit();
153     }
154 
155     @Override
156     public AbsoluteDate getMinDate() {
157         return min;
158     }
159 
160     @Override
161     public AbsoluteDate getMaxDate() {
162         return max;
163     }
164 
165     @Override
166     protected double getMass(final AbsoluteDate date) {
167         return getPropagator(date).propagate(date).getMass();
168     }
169 
170     @Override
171     public SpacecraftState getInitialState() {
172         return map.getFirstNonNullSpan().getData().getInitialState();
173     }
174 
175     @Override
176     protected void resetIntermediateState(final SpacecraftState state,
177                                           final boolean forward) {
178         throw new OrekitException(OrekitMessages.NON_RESETABLE_STATE);
179     }
180 
181     @Override
182     public void resetInitialState(final SpacecraftState state) {
183         throw new OrekitException(OrekitMessages.NON_RESETABLE_STATE);
184     }
185 
186     /**
187      * Get the propagator to use for the given date.
188      *
189      * @param date of query
190      * @return propagator to use on date.
191      */
192     private BoundedPropagator getPropagator(final AbsoluteDate date) {
193         final BoundedPropagator propagator = map.get(date);
194         if (propagator != null) {
195             return propagator;
196         } else {
197             // let the first propagator throw the exception
198             return map.getFirstNonNullSpan().getData();
199         }
200     }
201 
202     /** Local attitude provider. */
203     private class AggregateAttitudeProvider implements AttitudeProvider {
204 
205         /** {@inheritDoc} */
206         @Override
207         public Attitude getAttitude(final PVCoordinatesProvider pvProv,
208                                     final AbsoluteDate date,
209                                     final Frame frame) {
210             return getPropagator(date).getAttitudeProvider().getAttitude(pvProv, date, frame);
211         }
212 
213         /** {@inheritDoc} */
214         @Override
215         public <T extends CalculusFieldElement<T>> FieldAttitude<T> getAttitude(final FieldPVCoordinatesProvider<T> pvProv,
216                                                                                 final FieldAbsoluteDate<T> date,
217                                                                                 final Frame frame) {
218             return getPropagator(date.toAbsoluteDate()).getAttitudeProvider().getAttitude(pvProv, date, frame);
219         }
220 
221         /** {@inheritDoc} */
222         @Override
223         public Rotation getAttitudeRotation(final PVCoordinatesProvider pvProv, final AbsoluteDate date, final Frame frame) {
224             return getPropagator(date).getAttitudeProvider().getAttitudeRotation(pvProv, date, frame);
225         }
226 
227         /** {@inheritDoc} */
228         @Override
229         public <T extends CalculusFieldElement<T>> FieldRotation<T> getAttitudeRotation(final FieldPVCoordinatesProvider<T> pvProv,
230                                                                                         final FieldAbsoluteDate<T> date,
231                                                                                         final Frame frame) {
232             return getPropagator(date.toAbsoluteDate()).getAttitudeProvider().getAttitudeRotation(pvProv, date, frame);
233         }
234     }
235 
236 }