Class RobustKnownBiasAndGravityNormAccelerometerCalibrator
java.lang.Object
com.irurueta.navigation.inertial.calibration.accelerometer.RobustKnownBiasAndGravityNormAccelerometerCalibrator
- All Implemented Interfaces:
AccelerometerCalibrator
,AccelerometerNonLinearCalibrator
,KnownBiasAccelerometerCalibrator
,OrderedStandardDeviationBodyKinematicsAccelerometerCalibrator
,QualityScoredAccelerometerCalibrator
- Direct Known Subclasses:
LMedSRobustKnownBiasAndGravityNormAccelerometerCalibrator
,MSACRobustKnownBiasAndGravityNormAccelerometerCalibrator
,PROMedSRobustKnownBiasAndGravityNormAccelerometerCalibrator
,PROSACRobustKnownBiasAndGravityNormAccelerometerCalibrator
,RANSACRobustKnownBiasAndGravityNormAccelerometerCalibrator
public abstract class RobustKnownBiasAndGravityNormAccelerometerCalibrator
extends Object
implements AccelerometerNonLinearCalibrator, KnownBiasAccelerometerCalibrator, OrderedStandardDeviationBodyKinematicsAccelerometerCalibrator, QualityScoredAccelerometerCalibrator
This is an abstract class to robustly estimate accelerometer cross
couplings and scaling factors.
To use this calibrator at least 7 measurements taken at a single position where gravity norm is known must be taken at 7 different unknown orientations and zero velocity when common z-axis is assumed, otherwise at least 10 measurements are required.
Measured specific force is assumed to follow the model shown below:
fmeas = ba + (I + Ma) * ftrue + wWhere: - fmeas is the measured specific force. This is a 3x1 vector. - ba is accelerometer bias. Ideally, on a perfect accelerometer, this should be a 3x1 zero vector. - I is the 3x3 identity matrix. - Ma is the 3x3 matrix containing cross-couplings and scaling factors. Ideally, on a perfect accelerometer, this should be a 3x3 zero matrix. - ftrue is ground-truth specific force. - w is measurement noise.
-
Nested Class Summary
Nested ClassesModifier and TypeClassDescriptionprotected static class
Internal class containing estimated preliminary result. -
Field Summary
FieldsModifier and TypeFieldDescriptionprivate double
X-coordinate of known accelerometer bias.private double
Y-coordinate of known accelerometer bias.private double
Z-coordinate of known accelerometer bias.private boolean
This flag indicates whether z-axis is assumed to be common for accelerometer and gyroscope.protected double
Amount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%).static final double
Constant defining default confidence of the estimated result, which is 99%.static final boolean
Indicates that covariance is kept by default after refining result.static final int
Default maximum allowed number of iterations.static final float
Default amount of progress variation before notifying a change in estimation progress.static final boolean
Indicates that result is refined by default.static final com.irurueta.numerical.robust.RobustEstimatorMethod
Default robust estimator method when none is provided.static final boolean
Indicates whether by default a common z-axis is assumed for both the accelerometer and gyroscope.private double
Estimated chi square value.private com.irurueta.algebra.Matrix
Estimated covariance of estimated position.private com.irurueta.algebra.Matrix
Estimated accelerometer scale factors and cross coupling errors.private double
Estimated mean square error respect to provided measurements.protected Double
Ground truth gravity norm to be expected at location where measurements have been made, expressed in meters per squared second (m/s^2).protected com.irurueta.algebra.Matrix
Contains 3x3 identify to be reused.private double
Initial x-y cross coupling error.private double
Initial x-z cross coupling error.private double
Initial y-x cross coupling error.private double
Initial y-z cross coupling error.private double
Initial z-x cross coupling error.private double
Initial z-y cross coupling error.private double
Initial x scaling factor.private double
Initial y scaling factor.private double
Initial z scaling factor.protected com.irurueta.numerical.robust.InliersData
Data related to inliers found after calibration.private final KnownBiasAndGravityNormAccelerometerCalibrator
Inner calibrator to compute calibration for each subset of data or during final refining.private boolean
Indicates whether covariance must be kept after refining result.Listener to be notified of events such as when calibration starts, ends or its progress significantly changes.static final double
Maximum allowed confidence value.static final float
Maximum allowed value for progress delta.protected int
Maximum allowed number of iterations.protected List<StandardDeviationBodyKinematics>
Contains a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.static final double
Minimum allowed confidence value.static final int
Minimum allowed number of iterations.static final float
Minimum allowed value for progress delta.static final int
Required minimum number of measurements when common z-axis is assumed.static final int
Required minimum number of measurements for the general case.protected int
Size of subsets to be checked during robust estimation.protected float
Amount of progress variation before notifying a progress change during calibration.protected boolean
Indicates whether result must be refined using a non linear calibrator over found inliers.protected boolean
Indicates whether calibrator is running.protected com.irurueta.algebra.Matrix
Contains 3x3 temporary matrix.protected com.irurueta.algebra.Matrix
Contains 3x3 temporary matrix.protected com.irurueta.algebra.Matrix
Contains 3x1 temporary matrix.protected com.irurueta.algebra.Matrix
Contains 3x1 temporary matrix. -
Constructor Summary
ConstructorsModifierConstructorDescriptionprotected
Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(boolean commonAxisUsed) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(double[] bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.algebra.Matrix bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Constructor.protected
RobustKnownBiasAndGravityNormAccelerometerCalibrator
(List<StandardDeviationBodyKinematics> measurements) Constructor. -
Method Summary
Modifier and TypeMethodDescriptionprotected void
attemptRefine
(RobustKnownBiasAndGravityNormAccelerometerCalibrator.PreliminaryResult preliminaryResult) Attempts to refine calibration parameters if refinement is requested.protected double
computeError
(StandardDeviationBodyKinematics measurement, RobustKnownBiasAndGravityNormAccelerometerCalibrator.PreliminaryResult preliminaryResult) Computes error of preliminary result respect a given measurement for current gravity norm.protected void
computePreliminarySolutions
(int[] samplesIndices, List<RobustKnownBiasAndGravityNormAccelerometerCalibrator.PreliminaryResult> solutions) Computes a preliminary solution for a subset of samples picked by a robust estimator.private static double
convertAcceleration
(double value, com.irurueta.units.AccelerationUnit unit) Converts acceleration value and unit to meters per squared second.private static double
convertAcceleration
(com.irurueta.units.Acceleration acceleration) Converts acceleration instance to meters per squared second.create()
Creates a robust accelerometer calibrator using default robust method.create
(boolean commonAxisUsed) Creates a robust accelerometer calibrator using default robust method.create
(boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] bias) Creates a robust accelerometer calibrator using default robust method.create
(double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.Creates a robust accelerometer calibrator using default robust method.create
(RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] initialBias) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.Creates a robust accelerometer calibrator using default robust method.Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener) Creates a robust accelerometer calibrator using default robust method.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndGravityNormAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.create
(List<StandardDeviationBodyKinematics> measurements) Creates a robust accelerometer calibrator using default robust method.create
(List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.double[]
getBias()
Gets known bias as an array.void
getBias
(double[] result) Gets known bias as an array.com.irurueta.algebra.Matrix
Gets known bias as a column matrix.void
getBiasAsMatrix
(com.irurueta.algebra.Matrix result) Gets known bias as a column matrix.Gets known accelerometer bias.void
getBiasAsTriad
(AccelerationTriad result) Gets known accelerometer bias.double
getBiasX()
Gets x-coordinate of known accelerometer bias.com.irurueta.units.Acceleration
Gets x-coordinate of known accelerometer bias.void
getBiasXAsAcceleration
(com.irurueta.units.Acceleration result) Gets x-coordinate of known accelerometer bias.double
getBiasY()
Gets y-coordinate of known accelerometer bias.com.irurueta.units.Acceleration
Gets y-coordinate of known accelerometer bias.void
getBiasYAsAcceleration
(com.irurueta.units.Acceleration result) Gets y-coordinate of known accelerometer bias.double
getBiasZ()
Gets z-coordinate of known accelerometer bias.com.irurueta.units.Acceleration
Gets z-coordinate of known accelerometer bias.void
getBiasZAsAcceleration
(com.irurueta.units.Acceleration result) Gets z-coordinate of known accelerometer bias.double
Returns amount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%).double
Gets estimated chi square value.com.irurueta.algebra.Matrix
Gets estimated covariance matrix for estimated calibration solution.com.irurueta.algebra.Matrix
Gets estimated accelerometer scale factors and ross coupling errors.double
Gets estimated mean square error respect to provided measurements.Gets estimated x-y cross-coupling error.Gets estimated x-z cross-coupling error.Gets estimated y-x cross-coupling error.Gets estimated y-z cross-coupling error.Gets estimated z-x cross-coupling error.Gets estimated z-y cross-coupling error.Gets estimated x-axis scale factor.Gets estimated y-axis scale factor.Gets estimated z-axis scale factor.Gets ground truth gravity norm to be expected at location where measurements have been made, expressed in meter per squared second (m/s^2).com.irurueta.units.Acceleration
Gets ground truth gravity norm to be expected at location where measurements have been made.boolean
getGroundTruthGravityNormAsAcceleration
(com.irurueta.units.Acceleration result) Gets ground truth gravity norm to be expected at location where measurements have been made.com.irurueta.algebra.Matrix
Gets initial scale factors and cross coupling errors matrix.void
getInitialMa
(com.irurueta.algebra.Matrix result) Gets initial scale factors and cross coupling errors matrix.double
Gets initial x-y cross coupling error.double
Gets initial x-z cross coupling error.double
Gets initial y-x cross coupling error.double
Gets initial y-z cross coupling error.double
Gets initial z-x cross coupling error.double
Gets initial z-y cross coupling error.double
Gets initial x scaling factor.double
Gets initial y scaling factor.double
Gets initial z scaling factor.com.irurueta.numerical.robust.InliersData
Gets data related to inliers found after estimation.Gets listener to handle events raised by this estimator.int
Returns maximum allowed number of iterations.Gets a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.Indicates the type of measurement used by this calibrator.abstract com.irurueta.numerical.robust.RobustEstimatorMethod
Returns method being used for robust estimation.int
Gets minimum number of required measurements.int
Gets size of subsets to be checked during robust estimation.float
Returns amount of progress variation before notifying a progress change during calibration.double[]
Returns quality scores corresponding to each measurement.private void
internalSetGroundTruthGravityNorm
(Double groundTruthGravityNorm) Internally sets ground truth gravity norm to be expected at location where measurements have been made, expressed in meters per squared second (m/s^2).boolean
Indicates whether z-axis is assumed to be common for accelerometer and gyroscope.boolean
Indicates whether covariance must be kept after refining result.boolean
Indicates whether this calibrator requires ordered measurements in a list or not.boolean
isReady()
Indicates whether calibrator is ready to start.boolean
Indicates whether result must be refined using a non-linear solver over found inliers.boolean
Indicates whether calibrator is currently running or not.void
setBias
(double[] bias) Sets known bias as an array.void
setBias
(com.irurueta.algebra.Matrix bias) Sets known bias as an array.void
setBias
(AccelerationTriad bias) Sets known accelerometer bias.void
setBiasCoordinates
(double biasX, double biasY, double biasZ) Sets known bias coordinates of accelerometer expressed in meters per squared second (m/s^2).void
setBiasCoordinates
(com.irurueta.units.Acceleration biasX, com.irurueta.units.Acceleration biasY, com.irurueta.units.Acceleration biasZ) Sets known bias coordinates of accelerometer.void
setBiasX
(double biasX) Sets x-coordinate of known accelerometer bias.void
setBiasX
(com.irurueta.units.Acceleration biasX) Sets x-coordinate of known accelerometer bias.void
setBiasY
(double biasY) Sets y-coordinate of known accelerometer bias.void
setBiasY
(com.irurueta.units.Acceleration biasY) Sets y-coordinate of known accelerometer bias.void
setBiasZ
(double biasZ) Sets z-coordinate of known accelerometer bias.void
setBiasZ
(com.irurueta.units.Acceleration biasZ) Sets z-coordinate of known accelerometer bias to be used to find a solution.void
setCommonAxisUsed
(boolean commonAxisUsed) Specifies whether z-axis is assumed to be common for accelerometer and gyroscope.void
setConfidence
(double confidence) Sets amount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%).void
setCovarianceKept
(boolean keepCovariance) Specifies whether covariance must be kept after refining result.void
setGroundTruthGravityNorm
(com.irurueta.units.Acceleration groundTruthGravityNorm) Sets ground truth gravity norm to be expected at location where measurements have been made.void
setGroundTruthGravityNorm
(Double groundTruthGravityNorm) Sets ground truth gravity norm to be expected at location where measurements have been made, expressed in meters per squared second (m/s^2).void
setInitialCrossCouplingErrors
(double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Sets initial cross coupling errors.void
setInitialMa
(com.irurueta.algebra.Matrix initialMa) Sets initial scale factors and cross coupling errors matrix.void
setInitialMxy
(double initialMxy) Sets initial x-y cross coupling error.void
setInitialMxz
(double initialMxz) Sets initial x-z cross coupling error.void
setInitialMyx
(double initialMyx) Sets initial y-x cross coupling error.void
setInitialMyz
(double initialMyz) Sets initial y-z cross coupling error.void
setInitialMzx
(double initialMzx) Sets initial z-x cross coupling error.void
setInitialMzy
(double initialMzy) Sets initial z-y cross coupling error.void
setInitialScalingFactors
(double initialSx, double initialSy, double initialSz) Sets initial scaling factors.void
setInitialScalingFactorsAndCrossCouplingErrors
(double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Sets initial scaling factors and cross coupling errors.void
setInitialSx
(double initialSx) Sets initial x scaling factor.void
setInitialSy
(double initialSy) Sets initial y scaling factor.void
setInitialSz
(double initialSz) Sets initial z scaling factor.void
Sets listener to handle events raised by this estimator.void
setMaxIterations
(int maxIterations) Sets maximum allowed number of iterations.void
setMeasurements
(List<StandardDeviationBodyKinematics> measurements) Sets a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.void
setPreliminarySubsetSize
(int preliminarySubsetSize) Sets size of subsets to be checked during robust estimation.void
setProgressDelta
(float progressDelta) Sets amount of progress variation before notifying a progress change during calibration.void
setQualityScores
(double[] qualityScores) Sets quality scores corresponding to each measurement.void
setResultRefined
(boolean refineResult) Specifies whether result must be refined using a non-linear solver over found inliers.Methods inherited from class java.lang.Object
clone, equals, finalize, getClass, hashCode, notify, notifyAll, toString, wait, wait, wait
Methods inherited from interface com.irurueta.navigation.inertial.calibration.accelerometer.AccelerometerCalibrator
calibrate, isQualityScoresRequired
-
Field Details
-
DEFAULT_USE_COMMON_Z_AXIS
public static final boolean DEFAULT_USE_COMMON_Z_AXISIndicates whether by default a common z-axis is assumed for both the accelerometer and gyroscope.- See Also:
-
MINIMUM_MEASUREMENTS_COMMON_Z_AXIS
public static final int MINIMUM_MEASUREMENTS_COMMON_Z_AXISRequired minimum number of measurements when common z-axis is assumed.- See Also:
-
MINIMUM_MEASUREMENTS_GENERAL
public static final int MINIMUM_MEASUREMENTS_GENERALRequired minimum number of measurements for the general case.- See Also:
-
DEFAULT_ROBUST_METHOD
public static final com.irurueta.numerical.robust.RobustEstimatorMethod DEFAULT_ROBUST_METHODDefault robust estimator method when none is provided. -
DEFAULT_REFINE_RESULT
public static final boolean DEFAULT_REFINE_RESULTIndicates that result is refined by default.- See Also:
-
DEFAULT_KEEP_COVARIANCE
public static final boolean DEFAULT_KEEP_COVARIANCEIndicates that covariance is kept by default after refining result.- See Also:
-
DEFAULT_PROGRESS_DELTA
public static final float DEFAULT_PROGRESS_DELTADefault amount of progress variation before notifying a change in estimation progress. By default this is set to 5%.- See Also:
-
MIN_PROGRESS_DELTA
public static final float MIN_PROGRESS_DELTAMinimum allowed value for progress delta.- See Also:
-
MAX_PROGRESS_DELTA
public static final float MAX_PROGRESS_DELTAMaximum allowed value for progress delta.- See Also:
-
DEFAULT_CONFIDENCE
public static final double DEFAULT_CONFIDENCEConstant defining default confidence of the estimated result, which is 99%. This means that with a probability of 99% estimation will be accurate because chosen sub-samples will be inliers.- See Also:
-
DEFAULT_MAX_ITERATIONS
public static final int DEFAULT_MAX_ITERATIONSDefault maximum allowed number of iterations.- See Also:
-
MIN_CONFIDENCE
public static final double MIN_CONFIDENCEMinimum allowed confidence value.- See Also:
-
MAX_CONFIDENCE
public static final double MAX_CONFIDENCEMaximum allowed confidence value.- See Also:
-
MIN_ITERATIONS
public static final int MIN_ITERATIONSMinimum allowed number of iterations.- See Also:
-
measurements
Contains a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements. -
listener
Listener to be notified of events such as when calibration starts, ends or its progress significantly changes. -
running
protected boolean runningIndicates whether calibrator is running. -
progressDelta
protected float progressDeltaAmount of progress variation before notifying a progress change during calibration. -
confidence
protected double confidenceAmount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%). The amount of confidence indicates the probability that the estimated result is correct. Usually this value will be close to 1.0, but not exactly 1.0. -
maxIterations
protected int maxIterationsMaximum allowed number of iterations. When the maximum number of iterations is exceeded, result will not be available, however an approximate result will be available for retrieval. -
inliersData
protected com.irurueta.numerical.robust.InliersData inliersDataData related to inliers found after calibration. -
refineResult
protected boolean refineResultIndicates whether result must be refined using a non linear calibrator over found inliers. If true, inliers will be computed and kept in any implementation regardless of the settings. -
preliminarySubsetSize
protected int preliminarySubsetSizeSize of subsets to be checked during robust estimation. -
commonAxisUsed
private boolean commonAxisUsedThis flag indicates whether z-axis is assumed to be common for accelerometer and gyroscope. When enabled, this eliminates 3 variables from Ma matrix. -
biasX
private double biasXX-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2). -
biasY
private double biasYY-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2). -
biasZ
private double biasZZ-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2). -
initialSx
private double initialSxInitial x scaling factor. -
initialSy
private double initialSyInitial y scaling factor. -
initialSz
private double initialSzInitial z scaling factor. -
initialMxy
private double initialMxyInitial x-y cross coupling error. -
initialMxz
private double initialMxzInitial x-z cross coupling error. -
initialMyx
private double initialMyxInitial y-x cross coupling error. -
initialMyz
private double initialMyzInitial y-z cross coupling error. -
initialMzx
private double initialMzxInitial z-x cross coupling error. -
initialMzy
private double initialMzyInitial z-y cross coupling error. -
groundTruthGravityNorm
Ground truth gravity norm to be expected at location where measurements have been made, expressed in meters per squared second (m/s^2). -
estimatedMa
private com.irurueta.algebra.Matrix estimatedMaEstimated accelerometer scale factors and cross coupling errors. This is the product of matrix Ta containing cross coupling errors and Ka containing scaling factors. So tat:Ma = [sx mxy mxz] = Ta*Ka [myx sy myz] [mzx mzy sz ]
Where:Ka = [sx 0 0 ] [0 sy 0 ] [0 0 sz]
andTa = [1 -alphaXy alphaXz ] [alphaYx 1 -alphaYz] [-alphaZx alphaZy 1 ]
Hence:Ma = [sx mxy mxz] = Ta*Ka = [sx -sy * alphaXy sz * alphaXz ] [myx sy myz] [sx * alphaYx sy -sz * alphaYz] [mzx mzy sz ] [-sx * alphaZx sy * alphaZy sz ]
This instance allows any 3x3 matrix however, typically alphaYx, alphaZx and alphaZy are considered to be zero if the accelerometer z-axis is assumed to be the same as the body z-axis. When this is assumed, myx = mzx = mzy = 0 and the Ma matrix becomes upper diagonal:Ma = [sx mxy mxz] [0 sy myz] [0 0 sz ]
Values of this matrix are unit-less. -
keepCovariance
private boolean keepCovarianceIndicates whether covariance must be kept after refining result. This setting is only taken into account if result is refined. -
estimatedCovariance
private com.irurueta.algebra.Matrix estimatedCovarianceEstimated covariance of estimated position. This is only available when result has been refined and covariance is kept. -
estimatedChiSq
private double estimatedChiSqEstimated chi square value. -
estimatedMse
private double estimatedMseEstimated mean square error respect to provided measurements. -
innerCalibrator
Inner calibrator to compute calibration for each subset of data or during final refining. -
identity
protected com.irurueta.algebra.Matrix identityContains 3x3 identify to be reused. -
tmp1
protected com.irurueta.algebra.Matrix tmp1Contains 3x3 temporary matrix. -
tmp2
protected com.irurueta.algebra.Matrix tmp2Contains 3x3 temporary matrix. -
tmp3
protected com.irurueta.algebra.Matrix tmp3Contains 3x1 temporary matrix. -
tmp4
protected com.irurueta.algebra.Matrix tmp4Contains 3x1 temporary matrix.
-
-
Constructor Details
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator()Constructor. -
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(List<StandardDeviationBodyKinematics> measurements) Constructor.- Parameters:
measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(boolean commonAxisUsed) Constructor.- Parameters:
commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(double[] bias) Constructor.- Parameters:
bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Throws:
IllegalArgumentException
- if provided bias array does not have length 3.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.algebra.Matrix bias) Constructor.- Parameters:
bias
- known accelerometer bias.- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.- Parameters:
bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
RobustKnownBiasAndGravityNormAccelerometerCalibrator
protected RobustKnownBiasAndGravityNormAccelerometerCalibrator(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Constructor.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
-
Method Details
-
getBiasX
public double getBiasX()Gets x-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).- Specified by:
getBiasX
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- x-coordinate of known accelerometer bias.
-
setBiasX
public void setBiasX(double biasX) throws com.irurueta.navigation.LockedException Sets x-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).- Specified by:
setBiasX
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
biasX
- x-coordinate of known accelerometer bias.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getBiasY
public double getBiasY()Gets y-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).- Specified by:
getBiasY
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- y-coordinate of known accelerometer bias.
-
setBiasY
public void setBiasY(double biasY) throws com.irurueta.navigation.LockedException Sets y-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).- Specified by:
setBiasY
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
biasY
- y-coordinate of known accelerometer bias.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getBiasZ
public double getBiasZ()Gets z-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).- Specified by:
getBiasZ
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- z-coordinate of known accelerometer bias.
-
setBiasZ
public void setBiasZ(double biasZ) throws com.irurueta.navigation.LockedException Sets z-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).- Specified by:
setBiasZ
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
biasZ
- z-coordinate of known accelerometer bias.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getBiasXAsAcceleration
public com.irurueta.units.Acceleration getBiasXAsAcceleration()Gets x-coordinate of known accelerometer bias.- Specified by:
getBiasXAsAcceleration
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- x-coordinate of known accelerometer bias.
-
getBiasXAsAcceleration
public void getBiasXAsAcceleration(com.irurueta.units.Acceleration result) Gets x-coordinate of known accelerometer bias.- Specified by:
getBiasXAsAcceleration
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
result
- instance where result data will be stored.
-
setBiasX
public void setBiasX(com.irurueta.units.Acceleration biasX) throws com.irurueta.navigation.LockedException Sets x-coordinate of known accelerometer bias.- Specified by:
setBiasX
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
biasX
- x-coordinate of known accelerometer bias.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getBiasYAsAcceleration
public com.irurueta.units.Acceleration getBiasYAsAcceleration()Gets y-coordinate of known accelerometer bias.- Specified by:
getBiasYAsAcceleration
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- y-coordinate of known accelerometer bias.
-
getBiasYAsAcceleration
public void getBiasYAsAcceleration(com.irurueta.units.Acceleration result) Gets y-coordinate of known accelerometer bias.- Specified by:
getBiasYAsAcceleration
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
result
- instance where result data will be stored.
-
setBiasY
public void setBiasY(com.irurueta.units.Acceleration biasY) throws com.irurueta.navigation.LockedException Sets y-coordinate of known accelerometer bias.- Specified by:
setBiasY
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
biasY
- y-coordinate of known accelerometer bias.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getBiasZAsAcceleration
public com.irurueta.units.Acceleration getBiasZAsAcceleration()Gets z-coordinate of known accelerometer bias.- Specified by:
getBiasZAsAcceleration
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- z-coordinate of known accelerometer bias.
-
getBiasZAsAcceleration
public void getBiasZAsAcceleration(com.irurueta.units.Acceleration result) Gets z-coordinate of known accelerometer bias.- Specified by:
getBiasZAsAcceleration
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
result
- instance where result data will be stored.
-
setBiasZ
public void setBiasZ(com.irurueta.units.Acceleration biasZ) throws com.irurueta.navigation.LockedException Sets z-coordinate of known accelerometer bias to be used to find a solution.- Specified by:
setBiasZ
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
biasZ
- z-coordinate of known accelerometer bias.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
setBiasCoordinates
public void setBiasCoordinates(double biasX, double biasY, double biasZ) throws com.irurueta.navigation.LockedException Sets known bias coordinates of accelerometer expressed in meters per squared second (m/s^2).- Specified by:
setBiasCoordinates
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
biasX
- x-coordinate of known accelerometer bias.biasY
- y-coordinate of known accelerometer bias.biasZ
- z-coordinate of known accelerometer bias.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
setBiasCoordinates
public void setBiasCoordinates(com.irurueta.units.Acceleration biasX, com.irurueta.units.Acceleration biasY, com.irurueta.units.Acceleration biasZ) throws com.irurueta.navigation.LockedException Sets known bias coordinates of accelerometer.- Specified by:
setBiasCoordinates
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
biasX
- x-coordinate of known accelerometer bias.biasY
- y-coordinate of known accelerometer bias.biasZ
- z-coordinate of known accelerometer bias.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getBiasAsTriad
Gets known accelerometer bias.- Specified by:
getBiasAsTriad
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- known accelerometer bias.
-
getInitialSx
public double getInitialSx()Gets initial x scaling factor. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialSx
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial x scaling factor.
-
setInitialSx
public void setInitialSx(double initialSx) throws com.irurueta.navigation.LockedException Sets initial x scaling factor. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialSx
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialSx
- initial x scaling factor.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInitialSy
public double getInitialSy()Gets initial y scaling factor. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialSy
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial y scaling factor.
-
setInitialSy
public void setInitialSy(double initialSy) throws com.irurueta.navigation.LockedException Sets initial y scaling factor. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialSy
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialSy
- initial y scaling factor.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInitialSz
public double getInitialSz()Gets initial z scaling factor. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialSz
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial z scaling factor.
-
setInitialSz
public void setInitialSz(double initialSz) throws com.irurueta.navigation.LockedException Sets initial z scaling factor. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialSz
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialSz
- initial z scaling factor.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInitialMxy
public double getInitialMxy()Gets initial x-y cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialMxy
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial x-y cross coupling error.
-
setInitialMxy
public void setInitialMxy(double initialMxy) throws com.irurueta.navigation.LockedException Sets initial x-y cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialMxy
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialMxy
- initial x-y cross coupling error.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInitialMxz
public double getInitialMxz()Gets initial x-z cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialMxz
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial x-z cross coupling error.
-
setInitialMxz
public void setInitialMxz(double initialMxz) throws com.irurueta.navigation.LockedException Sets initial x-z cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialMxz
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialMxz
- initial x-z cross coupling error.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInitialMyx
public double getInitialMyx()Gets initial y-x cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialMyx
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial y-x cross coupling error.
-
setInitialMyx
public void setInitialMyx(double initialMyx) throws com.irurueta.navigation.LockedException Sets initial y-x cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialMyx
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialMyx
- initial y-x cross coupling error.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInitialMyz
public double getInitialMyz()Gets initial y-z cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialMyz
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial y-z cross coupling error.
-
setInitialMyz
public void setInitialMyz(double initialMyz) throws com.irurueta.navigation.LockedException Sets initial y-z cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialMyz
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialMyz
- initial y-z cross coupling error.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInitialMzx
public double getInitialMzx()Gets initial z-x cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialMzx
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial z-x cross coupling error.
-
setInitialMzx
public void setInitialMzx(double initialMzx) throws com.irurueta.navigation.LockedException Sets initial z-x cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialMzx
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialMzx
- initial z-x cross coupling error.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInitialMzy
public double getInitialMzy()Gets initial z-y cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialMzy
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial z-y cross coupling error.
-
setInitialMzy
public void setInitialMzy(double initialMzy) throws com.irurueta.navigation.LockedException Sets initial z-y cross coupling error. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialMzy
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialMzy
- initial z-y cross coupling error.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
setInitialScalingFactors
public void setInitialScalingFactors(double initialSx, double initialSy, double initialSz) throws com.irurueta.navigation.LockedException Sets initial scaling factors. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialScalingFactors
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialSx
- initial x scaling factor.initialSy
- initial y scaling factor.initialSz
- initial z scaling factor.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
setInitialCrossCouplingErrors
public void setInitialCrossCouplingErrors(double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) throws com.irurueta.navigation.LockedException Sets initial cross coupling errors. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialCrossCouplingErrors
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialMxy
- initial x-y cross coupling error.initialMxz
- initial x-z cross coupling error.initialMyx
- initial y-x cross coupling error.initialMyz
- initial y-z cross coupling error.initialMzx
- initial z-x cross coupling error.initialMzy
- initial z-y cross coupling error.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
setInitialScalingFactorsAndCrossCouplingErrors
public void setInitialScalingFactorsAndCrossCouplingErrors(double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) throws com.irurueta.navigation.LockedException Sets initial scaling factors and cross coupling errors. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialScalingFactorsAndCrossCouplingErrors
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialSx
- initial x scaling factor.initialSy
- initial y scaling factor.initialSz
- initial z scaling factor.initialMxy
- initial x-y cross coupling error.initialMxz
- initial x-z cross coupling error.initialMyx
- initial y-x cross coupling error.initialMyz
- initial y-z cross coupling error.initialMzx
- initial z-x cross coupling error.initialMzy
- initial z-y cross coupling error.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getBias
public double[] getBias()Gets known bias as an array. Array values are expressed in meters per squared second (m/s^2).- Specified by:
getBias
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- array containing coordinates of known bias.
-
getBias
public void getBias(double[] result) Gets known bias as an array. Array values are expressed in meters per squared second (m/s^2).- Specified by:
getBias
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
result
- instance where result data will be copied to.- Throws:
IllegalArgumentException
- if provided array does not have length 3.
-
setBias
public void setBias(double[] bias) throws com.irurueta.navigation.LockedException Sets known bias as an array. Array values are expressed in meters per squared second (m/s^2).- Specified by:
setBias
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
bias
- known bias to be set- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.IllegalArgumentException
- if provided array does not have length 3.
-
getBiasAsMatrix
public com.irurueta.algebra.Matrix getBiasAsMatrix()Gets known bias as a column matrix.- Specified by:
getBiasAsMatrix
in interfaceKnownBiasAccelerometerCalibrator
- Returns:
- known bias as a column matrix.
-
getBiasAsMatrix
public void getBiasAsMatrix(com.irurueta.algebra.Matrix result) Gets known bias as a column matrix.- Specified by:
getBiasAsMatrix
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
result
- instance where result data will be copied to.- Throws:
IllegalArgumentException
- if provided matrix is not 3x1.
-
setBias
public void setBias(com.irurueta.algebra.Matrix bias) throws com.irurueta.navigation.LockedException Sets known bias as an array.- Specified by:
setBias
in interfaceKnownBiasAccelerometerCalibrator
- Parameters:
bias
- bias to be set.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.IllegalArgumentException
- if provided matrix is not 3x1.
-
getInitialMa
public com.irurueta.algebra.Matrix getInitialMa()Gets initial scale factors and cross coupling errors matrix. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialMa
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- initial scale factors and cross coupling errors matrix.
-
getInitialMa
public void getInitialMa(com.irurueta.algebra.Matrix result) Gets initial scale factors and cross coupling errors matrix. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
getInitialMa
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
result
- instance where data will be stored.- Throws:
IllegalArgumentException
- if provided matrix is not 3x3.
-
setInitialMa
public void setInitialMa(com.irurueta.algebra.Matrix initialMa) throws com.irurueta.navigation.LockedException Sets initial scale factors and cross coupling errors matrix. This is only taken into account if non-linear preliminary solutions are used.- Specified by:
setInitialMa
in interfaceAccelerometerNonLinearCalibrator
- Parameters:
initialMa
- initial scale factors and cross coupling errors matrix.- Throws:
IllegalArgumentException
- if provided matrix is not 3x3.com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getGroundTruthGravityNorm
Gets ground truth gravity norm to be expected at location where measurements have been made, expressed in meter per squared second (m/s^2).- Returns:
- ground truth gravity norm or null.
-
setGroundTruthGravityNorm
public void setGroundTruthGravityNorm(Double groundTruthGravityNorm) throws com.irurueta.navigation.LockedException Sets ground truth gravity norm to be expected at location where measurements have been made, expressed in meters per squared second (m/s^2).- Parameters:
groundTruthGravityNorm
- ground truth gravity norm or null if undefined.- Throws:
IllegalArgumentException
- if provided value is negative.com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getGroundTruthGravityNormAsAcceleration
public com.irurueta.units.Acceleration getGroundTruthGravityNormAsAcceleration()Gets ground truth gravity norm to be expected at location where measurements have been made.- Returns:
- ground truth gravity norm or null.
-
getGroundTruthGravityNormAsAcceleration
public boolean getGroundTruthGravityNormAsAcceleration(com.irurueta.units.Acceleration result) Gets ground truth gravity norm to be expected at location where measurements have been made.- Parameters:
result
- instance where result will be stored.- Returns:
- true if ground truth gravity norm has been defined, false if it is not available yet.
-
setGroundTruthGravityNorm
public void setGroundTruthGravityNorm(com.irurueta.units.Acceleration groundTruthGravityNorm) throws com.irurueta.navigation.LockedException Sets ground truth gravity norm to be expected at location where measurements have been made.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm or null if undefined.- Throws:
IllegalArgumentException
- if provided value is negative.com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getMeasurements
Gets a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.- Specified by:
getMeasurements
in interfaceOrderedStandardDeviationBodyKinematicsAccelerometerCalibrator
- Returns:
- list of body kinematics measurements.
-
setMeasurements
public void setMeasurements(List<StandardDeviationBodyKinematics> measurements) throws com.irurueta.navigation.LockedException Sets a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.- Specified by:
setMeasurements
in interfaceOrderedStandardDeviationBodyKinematicsAccelerometerCalibrator
- Parameters:
measurements
- list of body kinematics measurements.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getMeasurementType
Indicates the type of measurement used by this calibrator.- Specified by:
getMeasurementType
in interfaceAccelerometerCalibrator
- Returns:
- type of measurement used by this calibrator.
-
isOrderedMeasurementsRequired
public boolean isOrderedMeasurementsRequired()Indicates whether this calibrator requires ordered measurements in a list or not.- Specified by:
isOrderedMeasurementsRequired
in interfaceAccelerometerCalibrator
- Returns:
- true if measurements must be ordered, false otherwise.
-
isCommonAxisUsed
public boolean isCommonAxisUsed()Indicates whether z-axis is assumed to be common for accelerometer and gyroscope. When enabled, this eliminates 3 variables from Ma matrix.- Specified by:
isCommonAxisUsed
in interfaceAccelerometerCalibrator
- Returns:
- true if z-axis is assumed to be common for accelerometer and gyroscope, false otherwise.
-
setCommonAxisUsed
public void setCommonAxisUsed(boolean commonAxisUsed) throws com.irurueta.navigation.LockedException Specifies whether z-axis is assumed to be common for accelerometer and gyroscope. When enabled, this eliminates 3 variables from Ma matrix.- Specified by:
setCommonAxisUsed
in interfaceAccelerometerCalibrator
- Parameters:
commonAxisUsed
- true if z-axis is assumed to be common for accelerometer and gyroscope, false otherwise.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getListener
Gets listener to handle events raised by this estimator.- Returns:
- listener to handle events raised by this estimator.
-
getMinimumRequiredMeasurements
public int getMinimumRequiredMeasurements()Gets minimum number of required measurements.- Specified by:
getMinimumRequiredMeasurements
in interfaceAccelerometerCalibrator
- Returns:
- minimum number of required measurements.
-
isReady
public boolean isReady()Indicates whether calibrator is ready to start.- Specified by:
isReady
in interfaceAccelerometerCalibrator
- Returns:
- true if calibrator is ready, false otherwise.
-
isRunning
public boolean isRunning()Indicates whether calibrator is currently running or not.- Specified by:
isRunning
in interfaceAccelerometerCalibrator
- Returns:
- true if calibrator is running, false otherwise.
-
getProgressDelta
public float getProgressDelta()Returns amount of progress variation before notifying a progress change during calibration.- Returns:
- amount of progress variation before notifying a progress change during calibration.
-
setProgressDelta
public void setProgressDelta(float progressDelta) throws com.irurueta.navigation.LockedException Sets amount of progress variation before notifying a progress change during calibration.- Parameters:
progressDelta
- amount of progress variation before notifying a progress change during calibration.- Throws:
IllegalArgumentException
- if progress delta is less than zero or greater than 1.com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getConfidence
public double getConfidence()Returns amount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%). The amount of confidence indicates the probability that the estimated result is correct. Usually this value will be close to 1.0, but not exactly 1.0.- Returns:
- amount of confidence as a value between 0.0 and 1.0.
-
setConfidence
public void setConfidence(double confidence) throws com.irurueta.navigation.LockedException Sets amount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%). The amount of confidence indicates the probability that the estimated result is correct. Usually this value will be close to 1.0, but not exactly 1.0.- Parameters:
confidence
- confidence to be set as a value between 0.0 and 1.0.- Throws:
IllegalArgumentException
- if provided value is not between 0.0 and 1.0.com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getMaxIterations
public int getMaxIterations()Returns maximum allowed number of iterations. If maximum allowed number of iterations is achieved without converging to a result when calling calibrate(), a RobustEstimatorException will be raised.- Returns:
- maximum allowed number of iterations.
-
setMaxIterations
public void setMaxIterations(int maxIterations) throws com.irurueta.navigation.LockedException Sets maximum allowed number of iterations. When the maximum number of iterations is exceeded, result will not be available, however an approximate result will be available for retrieval.- Parameters:
maxIterations
- maximum allowed number of iterations to be set.- Throws:
IllegalArgumentException
- if provided value is less than 1.com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getInliersData
public com.irurueta.numerical.robust.InliersData getInliersData()Gets data related to inliers found after estimation.- Returns:
- data related to inliers found after estimation.
-
isResultRefined
public boolean isResultRefined()Indicates whether result must be refined using a non-linear solver over found inliers.- Returns:
- true to refine result, false to simply use result found by robust estimator without further refining.
-
setResultRefined
public void setResultRefined(boolean refineResult) throws com.irurueta.navigation.LockedException Specifies whether result must be refined using a non-linear solver over found inliers.- Parameters:
refineResult
- true to refine result, false to simply use result found by robust estimator without further refining.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
isCovarianceKept
public boolean isCovarianceKept()Indicates whether covariance must be kept after refining result. This setting is only taken into account if result is refined.- Returns:
- true if covariance must be kept after refining result, false otherwise.
-
setCovarianceKept
public void setCovarianceKept(boolean keepCovariance) throws com.irurueta.navigation.LockedException Specifies whether covariance must be kept after refining result. This setting is only taken into account if result is refined.- Parameters:
keepCovariance
- true if covariance must be kept after refining result, false otherwise.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getQualityScores
public double[] getQualityScores()Returns quality scores corresponding to each measurement. The larger the score value the better the quality of the sample. This implementation always returns null. Subclasses using quality scores must implement proper behavior.- Specified by:
getQualityScores
in interfaceQualityScoredAccelerometerCalibrator
- Returns:
- quality scores corresponding to each sample.
-
setQualityScores
public void setQualityScores(double[] qualityScores) throws com.irurueta.navigation.LockedException Sets quality scores corresponding to each measurement. The larger the score value the better the quality of the sample. This implementation makes no action. Subclasses using quality scores must implement proper behaviour.- Specified by:
setQualityScores
in interfaceQualityScoredAccelerometerCalibrator
- Parameters:
qualityScores
- quality scores corresponding to each pair of matched points.- Throws:
IllegalArgumentException
- if provided quality scores length is smaller than minimum required samples.com.irurueta.navigation.LockedException
- if calibrator is currently running.
-
getEstimatedMa
public com.irurueta.algebra.Matrix getEstimatedMa()Gets estimated accelerometer scale factors and ross coupling errors. This is the product of matrix Ta containing cross coupling errors and Ka containing scaling factors. So tat:Ma = [sx mxy mxz] = Ta*Ka [myx sy myz] [mzx mzy sz ]
Where:Ka = [sx 0 0 ] [0 sy 0 ] [0 0 sz]
andTa = [1 -alphaXy alphaXz ] [alphaYx 1 -alphaYz] [-alphaZx alphaZy 1 ]
Hence:Ma = [sx mxy mxz] = Ta*Ka = [sx -sy * alphaXy sz * alphaXz ] [myx sy myz] [sx * alphaYx sy -sz * alphaYz] [mzx mzy sz ] [-sx * alphaZx sy * alphaZy sz ]
This instance allows any 3x3 matrix however, typically alphaYx, alphaZx and alphaZy are considered to be zero if the accelerometer z-axis is assumed to be the same as the body z-axis. When this is assumed, myx = mzx = mzy = 0 and the Ma matrix becomes upper diagonal:Ma = [sx mxy mxz] [0 sy myz] [0 0 sz ]
Values of this matrix are unit-less.- Specified by:
getEstimatedMa
in interfaceAccelerometerCalibrator
- Returns:
- estimated accelerometer scale factors and cross coupling errors, or null if not available.
-
getEstimatedSx
Gets estimated x-axis scale factor.- Specified by:
getEstimatedSx
in interfaceAccelerometerCalibrator
- Returns:
- estimated x-axis scale factor or null if not available.
-
getEstimatedSy
Gets estimated y-axis scale factor.- Specified by:
getEstimatedSy
in interfaceAccelerometerCalibrator
- Returns:
- estimated y-axis scale factor or null if not available.
-
getEstimatedSz
Gets estimated z-axis scale factor.- Specified by:
getEstimatedSz
in interfaceAccelerometerCalibrator
- Returns:
- estimated z-axis scale factor or null if not available.
-
getEstimatedMxy
Gets estimated x-y cross-coupling error.- Specified by:
getEstimatedMxy
in interfaceAccelerometerCalibrator
- Returns:
- estimated x-y cross-coupling error or null if not available.
-
getEstimatedMxz
Gets estimated x-z cross-coupling error.- Specified by:
getEstimatedMxz
in interfaceAccelerometerCalibrator
- Returns:
- estimated x-z cross-coupling error or null if not available.
-
getEstimatedMyx
Gets estimated y-x cross-coupling error.- Specified by:
getEstimatedMyx
in interfaceAccelerometerCalibrator
- Returns:
- estimated y-x cross-coupling error or null if not available.
-
getEstimatedMyz
Gets estimated y-z cross-coupling error.- Specified by:
getEstimatedMyz
in interfaceAccelerometerCalibrator
- Returns:
- estimated y-z cross-coupling error or null if not available.
-
getEstimatedMzx
Gets estimated z-x cross-coupling error.- Specified by:
getEstimatedMzx
in interfaceAccelerometerCalibrator
- Returns:
- estimated z-x cross-coupling error or null if not available.
-
getEstimatedMzy
Gets estimated z-y cross-coupling error.- Specified by:
getEstimatedMzy
in interfaceAccelerometerCalibrator
- Returns:
- estimated z-y cross-coupling error or null if not available.
-
getEstimatedCovariance
public com.irurueta.algebra.Matrix getEstimatedCovariance()Gets estimated covariance matrix for estimated calibration solution. Diagonal elements of the matrix contains variance for the following parameters (following indicated order): sx, sy, sz, mxy, mxz, myx, myz, mzx, mzy. This is only available when result has been refined and covariance is kept.- Specified by:
getEstimatedCovariance
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- estimated covariance matrix for estimated position.
-
getEstimatedChiSq
public double getEstimatedChiSq()Gets estimated chi square value.- Specified by:
getEstimatedChiSq
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- estimated chi square value.
-
getEstimatedMse
public double getEstimatedMse()Gets estimated mean square error respect to provided measurements.- Specified by:
getEstimatedMse
in interfaceAccelerometerNonLinearCalibrator
- Returns:
- estimated mean square error respect to provided measurements.
-
getPreliminarySubsetSize
public int getPreliminarySubsetSize()Gets size of subsets to be checked during robust estimation. This has to be at leastgetMinimumRequiredMeasurements()
.- Returns:
- size of subsets to be checked during robust estimation.
-
setPreliminarySubsetSize
public void setPreliminarySubsetSize(int preliminarySubsetSize) throws com.irurueta.navigation.LockedException Sets size of subsets to be checked during robust estimation. This has to be at leastgetMinimumRequiredMeasurements()
.- Parameters:
preliminarySubsetSize
- size of subsets to be checked during robust estimation.- Throws:
com.irurueta.navigation.LockedException
- if calibrator is currently running.IllegalArgumentException
- if provided value is less thangetMinimumRequiredMeasurements()
.
-
getMethod
public abstract com.irurueta.numerical.robust.RobustEstimatorMethod getMethod()Returns method being used for robust estimation.- Returns:
- method being used for robust estimation.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative or if provided quality scores length is smaller than 10 or 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative or if provided quality scores length is smaller than 10 or 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative or if provided quality scores length is smaller than 10 or 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative or if provided quality scores length is smaller than 10 or 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative or if provided quality scores length is smaller than 10 or 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative or if provided quality scores length is smaller than 10 or 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative or if provided quality scores length is smaller than 10 or 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative or if provided quality scores length is smaller than 13 samples.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(double[] qualityScores, com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method) Creates a robust accelerometer calibrator.- Parameters:
qualityScores
- quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.method
- robust estimator method.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
create
Creates a robust accelerometer calibrator using default robust method.- Returns:
- a robust accelerometer calibrator.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(List<StandardDeviationBodyKinematics> measurements) Creates a robust accelerometer calibrator using default robust method.- Parameters:
measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.- Returns:
- a robust accelerometer calibrator.
-
create
Creates a robust accelerometer calibrator using default robust method.- Parameters:
commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.- Returns:
- a robust accelerometer calibrator.
-
create
Creates a robust accelerometer calibrator using default robust method.- Parameters:
bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
bias
- known accelerometer bias.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.- Parameters:
bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(Double groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm expressed in meters per squared second (m/s^2).measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, double[] bias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] initialBias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.initialBias
- initial accelerometer bias to be used to find a solution. This must have length 3 and is expressed in meters per squared second (m/s^2).- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias array does not have length 3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if provided bias matrix is not 3x1 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
create
public static RobustKnownBiasAndGravityNormAccelerometerCalibrator create(com.irurueta.units.Acceleration groundTruthGravityNorm, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa) Creates a robust accelerometer calibrator using default robust method.- Parameters:
groundTruthGravityNorm
- ground truth gravity norm.measurements
- collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.commonAxisUsed
- indicates whether z-axis is assumed to be common for accelerometer and gyroscope.bias
- known accelerometer bias.initialMa
- initial scale factors and cross coupling errors matrix.- Returns:
- a robust accelerometer calibrator.
- Throws:
IllegalArgumentException
- if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided gravity norm value is negative.
-
computePreliminarySolutions
protected void computePreliminarySolutions(int[] samplesIndices, List<RobustKnownBiasAndGravityNormAccelerometerCalibrator.PreliminaryResult> solutions) Computes a preliminary solution for a subset of samples picked by a robust estimator.- Parameters:
samplesIndices
- indices of samples picked by the robust estimator.solutions
- list where estimated preliminary solution will be stored.
-
internalSetGroundTruthGravityNorm
Internally sets ground truth gravity norm to be expected at location where measurements have been made, expressed in meters per squared second (m/s^2).- Parameters:
groundTruthGravityNorm
- ground truth gravity norm or null if undefined.- Throws:
IllegalArgumentException
- if provided value is negative.
-
convertAcceleration
private static double convertAcceleration(double value, com.irurueta.units.AccelerationUnit unit) Converts acceleration value and unit to meters per squared second.- Parameters:
value
- acceleration value.unit
- unit of acceleration value.- Returns:
- converted value.
-
convertAcceleration
private static double convertAcceleration(com.irurueta.units.Acceleration acceleration) Converts acceleration instance to meters per squared second.- Parameters:
acceleration
- acceleration instance to be converted.- Returns:
- converted value.
-