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