1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23 package org.hipparchus.ode.sampling;
24
25 import org.hipparchus.exception.MathIllegalStateException;
26 import org.hipparchus.ode.EquationsMapper;
27 import org.hipparchus.ode.ODEStateAndDerivative;
28 import org.hipparchus.util.FastMath;
29
30
31
32
33
34
35
36
37
38
39
40
41
42 public abstract class AbstractODEStateInterpolator
43 implements ODEStateInterpolator {
44
45
46 private static final long serialVersionUID = 20160328L;
47
48
49 private final ODEStateAndDerivative globalPreviousState;
50
51
52 private final ODEStateAndDerivative globalCurrentState;
53
54
55 private final ODEStateAndDerivative softPreviousState;
56
57
58 private final ODEStateAndDerivative softCurrentState;
59
60
61 private final boolean forward;
62
63
64 private final EquationsMapper mapper;
65
66
67
68
69
70
71
72
73
74 protected AbstractODEStateInterpolator(final boolean isForward,
75 final ODEStateAndDerivative globalPreviousState,
76 final ODEStateAndDerivative globalCurrentState,
77 final ODEStateAndDerivative softPreviousState,
78 final ODEStateAndDerivative softCurrentState,
79 final EquationsMapper equationsMapper) {
80 this.forward = isForward;
81 this.globalPreviousState = globalPreviousState;
82 this.globalCurrentState = globalCurrentState;
83 this.softPreviousState = softPreviousState;
84 this.softCurrentState = softCurrentState;
85 this.mapper = equationsMapper;
86 }
87
88
89 @Override
90 public AbstractODEStateInterpolator restrictStep(final ODEStateAndDerivative previousState,
91 final ODEStateAndDerivative currentState) {
92 return create(forward, globalPreviousState, globalCurrentState, previousState, currentState, mapper);
93 }
94
95
96
97
98
99
100
101
102
103
104 protected abstract AbstractODEStateInterpolator create(boolean newForward,
105 ODEStateAndDerivative newGlobalPreviousState,
106 ODEStateAndDerivative newGlobalCurrentState,
107 ODEStateAndDerivative newSoftPreviousState,
108 ODEStateAndDerivative newSoftCurrentState,
109 EquationsMapper newMapper);
110
111
112
113
114
115 public ODEStateAndDerivative getGlobalPreviousState() {
116 return globalPreviousState;
117 }
118
119
120
121
122
123 public ODEStateAndDerivative getGlobalCurrentState() {
124 return globalCurrentState;
125 }
126
127
128 @Override
129 public ODEStateAndDerivative getPreviousState() {
130 return softPreviousState;
131 }
132
133
134 @Override
135 public boolean isPreviousStateInterpolated() {
136 return softPreviousState != globalPreviousState;
137 }
138
139
140 @Override
141 public ODEStateAndDerivative getCurrentState() {
142 return softCurrentState;
143 }
144
145
146 @Override
147 public boolean isCurrentStateInterpolated() {
148 return softCurrentState != globalCurrentState;
149 }
150
151
152 @Override
153 public ODEStateAndDerivative getInterpolatedState(final double time) {
154 if (FastMath.abs(globalCurrentState.getTime() - globalPreviousState.getTime()) <=
155 FastMath.ulp(globalCurrentState.getTime())) {
156 return globalCurrentState;
157 }
158 final double thetaH = time - globalPreviousState.getTime();
159 final double oneMinusThetaH = globalCurrentState.getTime() - time;
160 final double theta = thetaH / (globalCurrentState.getTime() - globalPreviousState.getTime());
161 return computeInterpolatedStateAndDerivatives(mapper, time, theta, thetaH, oneMinusThetaH);
162 }
163
164
165 @Override
166 public boolean isForward() {
167 return forward;
168 }
169
170
171
172
173 protected EquationsMapper getMapper() {
174 return mapper;
175 }
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190 protected abstract ODEStateAndDerivative computeInterpolatedStateAndDerivatives(EquationsMapper equationsMapper,
191 double time, double theta,
192 double thetaH, double oneMinusThetaH)
193 throws MathIllegalStateException;
194
195 }