Package org.orekit.estimation.sequential

Class UnscentedKalmanModel

java.lang.Object

org.orekit.estimation.sequential.UnscentedKalmanModel

All Implemented Interfaces:

UnscentedProcess<MeasurementDecorator>, KalmanEstimation

public class UnscentedKalmanModel
extends Object
implements UnscentedProcess<MeasurementDecorator>

Class defining the process model dynamics to use with a UnscentedKalmanEstimator.

Since:

11.3

Author:

Gaëtan Pierre, Bryan Cazabonne

Constructor Summary

Constructors

Modifier	Constructor	Description
protected	UnscentedKalmanModel(List<PropagatorBuilder> propagatorBuilders, List<CovarianceMatrixProvider> covarianceMatricesProviders, ParameterDriversList estimatedMeasurementParameters, CovarianceMatrixProvider measurementProcessNoiseMatrix)	Unscented Kalman process model constructor (package private).

Method Summary

Modifier and Type	Method	Description
void	finalizeEstimation(ObservedMeasurement<?> observedMeasurement, ProcessEstimate estimate)	Finalize estimation.
List<PropagatorBuilder>	getBuilders()	Getter for the propagators.
protected ProcessEstimate	getCorrectedEstimate()
EstimatedMeasurement<?>	getCorrectedMeasurement()	Get the estimated measurement.
SpacecraftState[]	getCorrectedSpacecraftStates()	Get the corrected spacecraft states.
protected int[][]	getCovarianceIndirection()
AbsoluteDate	getCurrentDate()	Get the current date.
int	getCurrentMeasurementNumber()	Get the current measurement number.
ProcessEstimate	getEstimate()	Get the current corrected estimate.
ParameterDriversList	getEstimatedMeasurementsParameters()	Get the list of estimated measurements parameters.
ParameterDriversList	getEstimatedOrbitalParameters()	Get the list of estimated orbital parameters.
protected ParameterDriversList[]	getEstimatedOrbitalParametersArray()
ParameterDriversList	getEstimatedPropagationParameters()	Get the list of estimated propagation parameters.
protected ParameterDriversList[]	getEstimatedPropagationParametersArray()
Propagator[]	getEstimatedPropagators()	Get the propagators estimated with the values set in the propagators builders.
UnscentedEvolution	getEvolution(double previousTime, RealVector[] sigmaPoints, MeasurementDecorator measurement)
RealVector	getInnovation(MeasurementDecorator measurement, RealVector predictedMeas, RealVector predictedState, RealMatrix innovationCovarianceMatrix)
protected Map<String,Integer>	getMeasurementParameterColumns()
protected RealMatrix	getNormalizedProcessNoise(int stateDimension)
protected int[]	getOrbitsStartColumns()
RealMatrix	getPhysicalEstimatedCovarianceMatrix()	Get the "physical" estimated covariance matrix (i.e.
RealVector	getPhysicalEstimatedState()	Get the "physical" estimated state (i.e.
RealMatrix	getPhysicalInnovationCovarianceMatrix()	Get the physical innovation covariance matrix.
RealMatrix	getPhysicalKalmanGain()	Get the physical Kalman gain matrix.
RealMatrix	getPhysicalMeasurementJacobian()	Get the physical Jacobian of the measurement with respect to the state (H matrix).
RealMatrix	getPhysicalStateTransitionMatrix()	Get physical state transition matrix between previous state and estimated (but not yet corrected) state.
EstimatedMeasurement<?>	getPredictedMeasurement()	Get the predicted measurement.
RealVector[]	getPredictedMeasurements(RealVector[] predictedSigmaPoints, MeasurementDecorator measurement)
SpacecraftState[]	getPredictedSpacecraftStates()	Get the predicted spacecraft states.
protected Map<String,Integer>	getPropagationParameterColumns()
protected AbsoluteDate	getReferenceDate()
protected double[]	getScale()
protected void	incrementCurrentMeasurementNumber()
protected void	setCorrectedEstimate(ProcessEstimate correctedEstimate)
protected void	setCorrectedMeasurement(EstimatedMeasurement<?> correctedMeasurement)
protected void	setCorrectedSpacecraftState(SpacecraftState correctedSpacecraftState, int index)
void	setCurrentDate(AbsoluteDate currentDate)
protected void	setPredictedMeasurement(EstimatedMeasurement<?> predictedMeasurement)
protected void	setPredictedSpacecraftState(SpacecraftState predictedSpacecraftState, int index)

Methods inherited from class java.lang.Object

clone, equals, finalize, getClass, hashCode, notify, notifyAll, toString, wait, wait, wait

Constructor Detail

UnscentedKalmanModel

protected UnscentedKalmanModel(List<PropagatorBuilder> propagatorBuilders,
                               List<CovarianceMatrixProvider> covarianceMatricesProviders,
                               ParameterDriversList estimatedMeasurementParameters,
                               CovarianceMatrixProvider measurementProcessNoiseMatrix)

Unscented Kalman process model constructor (package private).

Parameters:

propagatorBuilders - propagators builders used to evaluate the orbits.

covarianceMatricesProviders - provider for covariance matrix

estimatedMeasurementParameters - measurement parameters to estimate

measurementProcessNoiseMatrix - provider for measurement process noise matrix

Method Detail

getEvolution

public UnscentedEvolution getEvolution(double previousTime,
                                       RealVector[] sigmaPoints,
                                       MeasurementDecorator measurement)

Specified by:

getEvolution in interface UnscentedProcess<MeasurementDecorator>

getPredictedMeasurements

public RealVector[] getPredictedMeasurements(RealVector[] predictedSigmaPoints,
                                             MeasurementDecorator measurement)

Specified by:

getPredictedMeasurements in interface UnscentedProcess<MeasurementDecorator>

getInnovation

public RealVector getInnovation(MeasurementDecorator measurement,
                                RealVector predictedMeas,
                                RealVector predictedState,
                                RealMatrix innovationCovarianceMatrix)

Specified by:

getInnovation in interface UnscentedProcess<MeasurementDecorator>

finalizeEstimation

public void finalizeEstimation(ObservedMeasurement<?> observedMeasurement,
                               ProcessEstimate estimate)

Finalize estimation.

Parameters:

observedMeasurement - measurement that has just been processed

estimate - corrected estimate

getPhysicalStateTransitionMatrix

public RealMatrix getPhysicalStateTransitionMatrix()

Get physical state transition matrix between previous state and estimated (but not yet corrected) state.

Specified by:

getPhysicalStateTransitionMatrix in interface KalmanEstimation

Returns:

state transition matrix between previous state and estimated state (but not yet corrected) (may be null for initial process estimate)

getPhysicalMeasurementJacobian

public RealMatrix getPhysicalMeasurementJacobian()

Get the physical Jacobian of the measurement with respect to the state (H matrix).

Specified by:

getPhysicalMeasurementJacobian in interface KalmanEstimation

Returns:

physical Jacobian of the measurement with respect to the state (may be null for initial process estimate or if the measurement has been ignored)

getPhysicalInnovationCovarianceMatrix

public RealMatrix getPhysicalInnovationCovarianceMatrix()

Get the physical innovation covariance matrix.

Specified by:

getPhysicalInnovationCovarianceMatrix in interface KalmanEstimation

Returns:

physical innovation covariance matrix (may be null for initial process estimate or if the measurement has been ignored)

getPhysicalKalmanGain

public RealMatrix getPhysicalKalmanGain()

Get the physical Kalman gain matrix.

Specified by:

getPhysicalKalmanGain in interface KalmanEstimation

Returns:

Kalman gain matrix (may be null for initial process estimate or if the measurement has been ignored)

getPredictedSpacecraftStates

public SpacecraftState[] getPredictedSpacecraftStates()

Get the predicted spacecraft states.

Specified by:

getPredictedSpacecraftStates in interface KalmanEstimation

Returns:

predicted spacecraft states

getCorrectedSpacecraftStates

public SpacecraftState[] getCorrectedSpacecraftStates()

Get the corrected spacecraft states.

Specified by:

getCorrectedSpacecraftStates in interface KalmanEstimation

Returns:

corrected spacecraft states

getCurrentMeasurementNumber

public int getCurrentMeasurementNumber()

Get the current measurement number.

Specified by:

getCurrentMeasurementNumber in interface KalmanEstimation

Returns:

current measurement number

getCurrentDate

public AbsoluteDate getCurrentDate()

Get the current date.

Specified by:

getCurrentDate in interface KalmanEstimation

Returns:

current date

getPredictedMeasurement

public EstimatedMeasurement<?> getPredictedMeasurement()

Get the predicted measurement.

This estimation has been evaluated on the last predicted orbits

Specified by:

getPredictedMeasurement in interface KalmanEstimation

Returns:

predicted measurement

getCorrectedMeasurement

public EstimatedMeasurement<?> getCorrectedMeasurement()

Get the estimated measurement.

This estimation has been evaluated on the last corrected orbits

Specified by:

getCorrectedMeasurement in interface KalmanEstimation

Returns:

corrected measurement

getPhysicalEstimatedState

public RealVector getPhysicalEstimatedState()

Get the "physical" estimated state (i.e. not normalized)

Specified by:

getPhysicalEstimatedState in interface KalmanEstimation

Returns:

the "physical" estimated state

getPhysicalEstimatedCovarianceMatrix

public RealMatrix getPhysicalEstimatedCovarianceMatrix()

Get the "physical" estimated covariance matrix (i.e. not normalized)

Specified by:

getPhysicalEstimatedCovarianceMatrix in interface KalmanEstimation

Returns:

the "physical" estimated covariance matrix

getEstimatedOrbitalParameters

public ParameterDriversList getEstimatedOrbitalParameters()

Get the list of estimated orbital parameters.

Specified by:

getEstimatedOrbitalParameters in interface KalmanEstimation

Returns:

the list of estimated orbital parameters

getEstimatedPropagationParameters

public ParameterDriversList getEstimatedPropagationParameters()

Get the list of estimated propagation parameters.

Specified by:

getEstimatedPropagationParameters in interface KalmanEstimation

Returns:

the list of estimated propagation parameters

getEstimatedMeasurementsParameters

public ParameterDriversList getEstimatedMeasurementsParameters()

Get the list of estimated measurements parameters.

Specified by:

getEstimatedMeasurementsParameters in interface KalmanEstimation

Returns:

the list of estimated measurements parameters

getEstimate

public ProcessEstimate getEstimate()

Get the current corrected estimate.

Returns:

current corrected estimate

getBuilders

public List<PropagatorBuilder> getBuilders()

Getter for the propagators.

Returns:

the propagators

getEstimatedPropagators

public Propagator[] getEstimatedPropagators()

Get the propagators estimated with the values set in the propagators builders.

Returns:

propagators based on the current values in the builder

getNormalizedProcessNoise

protected RealMatrix getNormalizedProcessNoise(int stateDimension)

getOrbitsStartColumns

protected int[] getOrbitsStartColumns()

getPropagationParameterColumns

protected Map<String,Integer> getPropagationParameterColumns()

getMeasurementParameterColumns

protected Map<String,Integer> getMeasurementParameterColumns()

getEstimatedPropagationParametersArray

protected ParameterDriversList[] getEstimatedPropagationParametersArray()

getEstimatedOrbitalParametersArray

protected ParameterDriversList[] getEstimatedOrbitalParametersArray()

getCovarianceIndirection

protected int[][] getCovarianceIndirection()

getScale

protected double[] getScale()

getCorrectedEstimate

protected ProcessEstimate getCorrectedEstimate()

setCorrectedEstimate

protected void setCorrectedEstimate(ProcessEstimate correctedEstimate)

getReferenceDate

protected AbsoluteDate getReferenceDate()

incrementCurrentMeasurementNumber

protected void incrementCurrentMeasurementNumber()

setCurrentDate

public void setCurrentDate(AbsoluteDate currentDate)

setCorrectedSpacecraftState

protected void setCorrectedSpacecraftState(SpacecraftState correctedSpacecraftState,
                                           int index)

setPredictedSpacecraftState

protected void setPredictedSpacecraftState(SpacecraftState predictedSpacecraftState,
                                           int index)

setPredictedMeasurement

protected void setPredictedMeasurement(EstimatedMeasurement<?> predictedMeasurement)

setCorrectedMeasurement

protected void setCorrectedMeasurement(EstimatedMeasurement<?> correctedMeasurement)