1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17 package org.orekit.propagation;
18
19 import org.hipparchus.linear.RealMatrix;
20 import org.orekit.attitudes.AttitudeProvider;
21 import org.orekit.errors.OrekitException;
22 import org.orekit.errors.OrekitMessages;
23 import org.orekit.frames.Frame;
24 import org.orekit.propagation.sampling.StepHandlerMultiplexer;
25 import org.orekit.time.AbsoluteDate;
26 import org.orekit.utils.DataDictionary;
27 import org.orekit.utils.DoubleArrayDictionary;
28 import org.orekit.utils.TimeSpanMap;
29
30 import java.util.ArrayList;
31 import java.util.Collections;
32 import java.util.HashMap;
33 import java.util.LinkedList;
34 import java.util.List;
35 import java.util.Map;
36 import java.util.Queue;
37
38
39
40
41
42
43
44
45
46 public abstract class AbstractPropagator implements Propagator {
47
48
49 private final StepHandlerMultiplexer multiplexer;
50
51
52 private AbsoluteDate startDate;
53
54
55 private AttitudeProvider attitudeProvider;
56
57
58 private final List<AdditionalDataProvider<?>> additionalDataProviders;
59
60
61 private final Map<String, TimeSpanMap<Object>> unmanagedStates;
62
63
64 private SpacecraftState initialState;
65
66
67 private AbstractMatricesHarvester harvester;
68
69
70
71 protected AbstractPropagator() {
72 multiplexer = new StepHandlerMultiplexer();
73 additionalDataProviders = new ArrayList<>();
74 unmanagedStates = new HashMap<>();
75 harvester = null;
76 }
77
78
79
80
81 protected void setStartDate(final AbsoluteDate startDate) {
82 this.startDate = startDate;
83 }
84
85
86
87
88 protected AbsoluteDate getStartDate() {
89 return startDate;
90 }
91
92
93 public AttitudeProvider getAttitudeProvider() {
94 return attitudeProvider;
95 }
96
97
98 public void setAttitudeProvider(final AttitudeProvider attitudeProvider) {
99 this.attitudeProvider = attitudeProvider;
100 }
101
102
103 @Override
104 public SpacecraftState getBaseInitialState() {
105 return initialState;
106 }
107
108
109 @Override
110 public SpacecraftState getInitialState() {
111 return updateAdditionalData(getBaseInitialState());
112 }
113
114
115 public Frame getFrame() {
116 return initialState.getFrame();
117 }
118
119
120 public void resetInitialState(final SpacecraftState state) {
121 initialState = state;
122 setStartDate(state.getDate());
123 }
124
125
126 public StepHandlerMultiplexer getMultiplexer() {
127 return multiplexer;
128 }
129
130
131 @Override
132 public void addAdditionalDataProvider(final AdditionalDataProvider<?> provider) {
133
134
135 if (isAdditionalDataManaged(provider.getName())) {
136
137 throw new OrekitException(OrekitMessages.ADDITIONAL_STATE_NAME_ALREADY_IN_USE,
138 provider.getName());
139 }
140
141
142 additionalDataProviders.add(provider);
143
144 }
145
146
147 @Override
148 public List<AdditionalDataProvider<?>> getAdditionalDataProviders() {
149 return Collections.unmodifiableList(additionalDataProviders);
150 }
151
152
153
154
155
156
157 public void removeAdditionalDataProvider(final String name) {
158 additionalDataProviders.removeIf(provider -> provider.getName().equals(name));
159 }
160
161
162 @Override
163 public MatricesHarvester setupMatricesComputation(final String stmName, final RealMatrix initialStm,
164 final DoubleArrayDictionary initialJacobianColumns) {
165 if (stmName == null) {
166 throw new OrekitException(OrekitMessages.NULL_ARGUMENT, "stmName");
167 }
168 harvester = createHarvester(stmName, initialStm, initialJacobianColumns);
169 return harvester;
170 }
171
172
173
174
175
176 public void clearMatricesComputation() {
177 harvester = null;
178 }
179
180
181
182
183
184
185
186
187
188
189
190 protected AbstractMatricesHarvester createHarvester(final String stmName, final RealMatrix initialStm,
191 final DoubleArrayDictionary initialJacobianColumns) {
192
193 throw new UnsupportedOperationException();
194 }
195
196
197
198
199
200 protected AbstractMatricesHarvester getHarvester() {
201 return harvester;
202 }
203
204
205
206
207
208
209 protected SpacecraftState updateUnmanagedData(final SpacecraftState original) {
210
211
212
213 SpacecraftState updated = original;
214
215
216 for (final Map.Entry<String, TimeSpanMap<Object>> entry : unmanagedStates.entrySet()) {
217 updated = updated.addAdditionalData(entry.getKey(),
218 entry.getValue().get(original.getDate()));
219 }
220
221 return updated;
222
223 }
224
225
226
227
228
229
230
231
232 public SpacecraftState updateAdditionalData(final SpacecraftState original) {
233
234
235 SpacecraftState updated = updateUnmanagedData(original);
236
237
238 final Queue<AdditionalDataProvider<?>> pending = new LinkedList<>(getAdditionalDataProviders());
239
240
241 int yieldCount = 0;
242 while (!pending.isEmpty()) {
243 final AdditionalDataProvider<?> provider = pending.remove();
244 if (provider.yields(updated)) {
245
246
247 pending.add(provider);
248 if (++yieldCount >= pending.size()) {
249
250
251
252 break;
253 }
254 } else {
255
256 updated = provider.update(updated);
257 yieldCount = 0;
258 }
259 }
260
261 return updated;
262
263 }
264
265
266
267
268
269
270 protected void initializeAdditionalData(final AbsoluteDate target) {
271 for (final AdditionalDataProvider<?> provider : additionalDataProviders) {
272 provider.init(initialState, target);
273 }
274 }
275
276
277 public boolean isAdditionalDataManaged(final String name) {
278 for (final AdditionalDataProvider<?> provider : additionalDataProviders) {
279 if (provider.getName().equals(name)) {
280 return true;
281 }
282 }
283 return false;
284 }
285
286
287 public String[] getManagedAdditionalData() {
288 final String[] managed = new String[additionalDataProviders.size()];
289 for (int i = 0; i < managed.length; ++i) {
290 managed[i] = additionalDataProviders.get(i).getName();
291 }
292 return managed;
293 }
294
295
296 public SpacecraftState propagate(final AbsoluteDate target) {
297 if (startDate == null) {
298 startDate = getInitialState().getDate();
299 }
300 return propagate(startDate, target);
301 }
302
303
304
305
306 protected void initializePropagation() {
307
308 unmanagedStates.clear();
309
310 if (initialState != null) {
311
312
313
314 for (final DataDictionary.Entry initial : initialState.getAdditionalDataValues().getData()) {
315 if (!isAdditionalDataManaged(initial.getKey())) {
316
317
318 unmanagedStates.put(initial.getKey(), new TimeSpanMap<>(initial.getValue()));
319 }
320 }
321 }
322 }
323
324
325
326
327 protected void stateChanged(final SpacecraftState state) {
328 final AbsoluteDate date = state.getDate();
329 final boolean forward = date.durationFrom(getStartDate()) >= 0.0;
330 for (final DataDictionary.Entry changed : state.getAdditionalDataValues().getData()) {
331 final TimeSpanMap<Object> tsm = unmanagedStates.get(changed.getKey());
332 if (tsm != null) {
333
334 if (forward) {
335 tsm.addValidAfter(changed.getValue(), date, false);
336 } else {
337 tsm.addValidBefore(changed.getValue(), date, false);
338 }
339 }
340 }
341 }
342
343 }