/* Copyright 2002-2017 CS Systèmes d'Information
* Licensed to CS Systèmes d'Information (CS) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership.
* CS licenses this file to You under the Apache License, Version 2.0
* (the "License"); you may not use this file except in compliance with
* the License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
package org.orekit.estimation.measurements;
import java.util.IdentityHashMap;
import java.util.Map;
import org.orekit.errors.OrekitIllegalArgumentException;
import org.orekit.errors.OrekitMessages;
import org.orekit.propagation.SpacecraftState;
import org.orekit.time.AbsoluteDate;
import org.orekit.time.TimeStamped;
import org.orekit.utils.ParameterDriver;
/** Class holding an estimated theoretical value associated to an {@link ObservedMeasurement observed measurement}.
* @param <T> the type of the measurement
* @author Luc Maisonobe
* @since 8.0
*/
public class EstimatedMeasurement<T extends ObservedMeasurement<T>> implements TimeStamped {
/** Associated observed measurement. */
private final T observedMeasurement;
/** Iteration number. */
private final int iteration;
/** Evaluations counter. */
private final int count;
/** State of the spacecraft. */
private final SpacecraftState state;
/** Estimated value. */
private double[] estimatedValue;
/** Current weight. */
private double[] currentWeight;
/** Partial derivatives with respect to state. */
private double[][] stateDerivatives;
/** Partial derivatives with respect to parameters. */
private final Map<ParameterDriver, double[]> parametersDerivatives;
/** Simple constructor.
* @param observedMeasurement associated observed measurement
* @param iteration iteration number
* @param count evaluations counter
* @param state state of the spacecraft
*/
public EstimatedMeasurement(final T observedMeasurement,
final int iteration, final int count,
final SpacecraftState state) {
this.observedMeasurement = observedMeasurement;
this.iteration = iteration;
this.count = count;
this.state = state;
this.parametersDerivatives = new IdentityHashMap<ParameterDriver, double[]>();
}
/** Get the associated observed measurement.
* @return associated observed measurement
*/
public T getObservedMeasurement() {
return observedMeasurement;
}
/** {@inheritDoc} */
@Override
public AbsoluteDate getDate() {
return observedMeasurement.getDate();
}
/** Get the iteration number.
* @return iteration number
*/
public int getIteration() {
return iteration;
}
/** Get the evaluations counter.
* @return evaluations counter
*/
public int getCount() {
return count;
}
/** Get the state of the spacecraft.
* @return state of the spacecraft
*/
public SpacecraftState getState() {
return state;
}
/** Get the time offset from state date to measurement date.
* @return time offset from state date to measurement date
*/
public double getTimeOffset() {
return observedMeasurement.getDate().durationFrom(state.getDate());
}
/** Get the estimated value.
* @return estimated value
*/
public double[] getEstimatedValue() {
return estimatedValue.clone();
}
/** Set the estimated value.
* @param estimatedValue estimated value
*/
public void setEstimatedValue(final double... estimatedValue) {
this.estimatedValue = estimatedValue.clone();
}
/** Get the current weight.
* <p>
* By default, the current weight is measurement {@link
* ObservedMeasurement#getBaseWeight() base weight}.
* </p>
* @return current weight
*/
public double[] getCurrentWeight() {
return currentWeight == null ? observedMeasurement.getBaseWeight() : currentWeight.clone();
}
/** Set the current weight.
* @param currentWeight current weight
*/
public void setCurrentWeight(final double... currentWeight) {
this.currentWeight = currentWeight.clone();
}
/** Get the partial derivatives of the {@link #getEstimatedValue()
* simulated measurement} with respect to state Cartesian coordinates.
* @return partial derivatives of the simulated value (array of size
* {@link ObservedMeasurement#getDimension() dimension} x 6)
*/
public double[][] getStateDerivatives() {
final double[][] sd = new double[observedMeasurement.getDimension()][];
for (int i = 0; i < observedMeasurement.getDimension(); ++i) {
sd[i] = stateDerivatives[i].clone();
}
return sd;
}
/** Set the partial derivatives of the {@link #getEstimatedValue()
* simulated measurement} with respect to state Cartesian coordinates.
* @param stateDerivatives partial derivatives with respect to state
*/
public void setStateDerivatives(final double[]... stateDerivatives) {
this.stateDerivatives = new double[observedMeasurement.getDimension()][];
for (int i = 0; i < observedMeasurement.getDimension(); ++i) {
this.stateDerivatives[i] = stateDerivatives[i].clone();
}
}
/** Get the partial derivatives of the {@link #getEstimatedValue()
* simulated measurement} with respect to a parameter.
* @param driver driver for the parameter
* @return partial derivatives of the simulated value
* @exception OrekitIllegalArgumentException if parameter is unknown
*/
public double[] getParameterDerivatives(final ParameterDriver driver)
throws OrekitIllegalArgumentException {
final double[] p = parametersDerivatives.get(driver);
if (p == null) {
final StringBuilder builder = new StringBuilder();
for (final Map.Entry<ParameterDriver, double[]> entry : parametersDerivatives.entrySet()) {
if (builder.length() > 0) {
builder.append(", ");
}
builder.append(entry.getKey().getName());
}
throw new OrekitIllegalArgumentException(OrekitMessages.UNSUPPORTED_PARAMETER_NAME,
driver.getName(),
builder.length() > 0 ? builder.toString() : "<none>");
}
return p;
}
/** Set the partial derivatives of the {@link #getEstimatedValue()
* simulated measurement} with respect to parameter.
* @param driver driver for the parameter
* @param parameterDerivatives partial derivatives with respect to parameter
*/
public void setParameterDerivatives(final ParameterDriver driver, final double... parameterDerivatives) {
parametersDerivatives.put(driver, parameterDerivatives);
}
}