1   /* Copyright 2022-2026 Thales Alenia Space
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.time.clocks;
18  
19  import java.util.ArrayList;
20  import java.util.HashMap;
21  import java.util.List;
22  import java.util.Map;
23  import java.util.function.DoubleFunction;
24  
25  import org.hipparchus.CalculusFieldElement;
26  import org.hipparchus.Field;
27  import org.hipparchus.analysis.differentiation.Gradient;
28  import org.orekit.errors.OrekitException;
29  import org.orekit.errors.OrekitMessages;
30  import org.orekit.time.AbsoluteDate;
31  import org.orekit.utils.drivers.ParameterDriver;
32  import org.orekit.utils.TimeSpanMap;
33  
34  /**
35   * Offset clock model aggregating several other clock models.
36   *
37   * @author Luc Maisonobe
38   * @since 12.1
39   */
40  public class AggregatedClockModel implements ClockModel {
41  
42      /** Underlying clock models. */
43      private final TimeSpanMap<ClockModel> models;
44  
45      /** Cached field-based models.
46       * @since 14.0
47       */
48      private final Map<Field<? extends CalculusFieldElement<?>>, AggregatedFieldClockModel<?>> fieldModels;
49  
50      /** Simple constructor.
51       * @param models underlying clock models
52       */
53      public AggregatedClockModel(final TimeSpanMap<ClockModel> models) {
54  
55          try {
56              // we ignore the result, we just want to check some data is present
57              models.getFirstNonNullSpan();
58          } catch (OrekitException oe) {
59              throw new OrekitException(oe, OrekitMessages.NOT_ENOUGH_DATA, 0);
60          }
61  
62          this.models      = models;
63          this.fieldModels = new HashMap<>();
64      }
65  
66      /** Get the underlying models.
67       * @return underlying models
68       */
69      public TimeSpanMap<ClockModel> getModels() {
70          return models;
71      }
72  
73      /** {@inheritDoc} */
74      @Override
75      public AbsoluteDate getValidityStart() {
76          return models.getFirstNonNullSpan().getStart();
77      }
78  
79      /** {@inheritDoc} */
80      @Override
81      public AbsoluteDate getValidityEnd() {
82          return models.getLastNonNullSpan().getEnd();
83      }
84  
85      /** {@inheritDoc} */
86      @Override
87      public List<ParameterDriver> getParametersDrivers() {
88          final List<ParameterDriver> drivers = new ArrayList<>();
89          models.forEach(model -> drivers.addAll(model.getParametersDrivers()));
90          return drivers;
91      }
92  
93      /** {@inheritDoc} */
94      @Override
95      public ClockOffset getOffset(final AbsoluteDate date) {
96          return getModel(date).getOffset(date);
97      }
98  
99      /** {@inheritDoc} */
100     @Override
101     @SuppressWarnings("unchecked")
102     public <T extends CalculusFieldElement<T>> AggregatedFieldClockModel<T> toField(final DoubleFunction<T> converter) {
103         // build aggregated models may be costly, so we cache the results
104         return (AggregatedFieldClockModel<T>) fieldModels.computeIfAbsent(converter.apply(0.0).getField(),
105                                                                           f -> buildFieldModel(converter));
106     }
107 
108     /**
109      * Build a field model.
110      * @param <T> type of the field elements
111      * @param converter converter to field elements
112      * @return field version of the instance
113      * @since 14.0
114      */
115     private <T extends CalculusFieldElement<T>> AggregatedFieldClockModel<T> buildFieldModel(final DoubleFunction<T> converter) {
116         final TimeSpanMap<FieldClockModel<T>> fieldMap = new TimeSpanMap<>(null);
117         for (TimeSpanMap.Span<ClockModel> span = models.getFirstSpan(); span != null; span = span.next()) {
118             fieldMap.addValidBetween(span.getData() == null ? null : span.getData().toField(converter),
119                                      span.getStart(), span.getEnd());
120         }
121         return new AggregatedFieldClockModel<>(fieldMap);
122     }
123 
124     /** {@inheritDoc} */
125     @Override
126     public AggregatedFieldClockModel<Gradient> toGradient(final int freeParameters, final Map<String, Integer> indices) {
127         final TimeSpanMap<FieldClockModel<Gradient>> fieldMap = new TimeSpanMap<>(null);
128         for (TimeSpanMap.Span<ClockModel> span = models.getFirstSpan(); span != null; span = span.next()) {
129             fieldMap.addValidBetween(span.getData() == null ?
130                                      null :
131                                      span.getData().toGradient(freeParameters, indices),
132                                      span.getStart(), span.getEnd());
133         }
134         return new AggregatedFieldClockModel<>(fieldMap);
135     }
136 
137     /**
138      * Get the model valid at specified date.
139      *
140      * @param date date for which model is requested
141      * @return clock model valid at date
142      */
143     private ClockModel getModel(final AbsoluteDate date) {
144         final ClockModel clockModel = models.get(date);
145         if (clockModel == null) {
146             // this may happen if map is limited or not contiguous
147             // typically for models retrieved from SP3Ephemeris
148             throw new OrekitException(OrekitMessages.NO_DATA_GENERATED, date);
149         }
150         return clockModel;
151     }
152 
153 }