Class KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
java.lang.Object
com.irurueta.navigation.inertial.calibration.magnetometer.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
- All Implemented Interfaces:
KnownHardIronAndFrameMagnetometerCalibrator<StandardDeviationFrameBodyMagneticFluxDensity,,KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener> KnownHardIronMagnetometerCalibrator,MagnetometerCalibrator,MagnetometerNonLinearCalibrator,UnorderedStandardDeviationFrameBodyMagneticFluxDensityMagnetometerCalibrator
public class KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
extends Object
implements KnownHardIronAndFrameMagnetometerCalibrator<StandardDeviationFrameBodyMagneticFluxDensity,KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener>, MagnetometerNonLinearCalibrator, UnorderedStandardDeviationFrameBodyMagneticFluxDensityMagnetometerCalibrator
Estimates magnetometer soft-iron cross couplings and scaling factors.
This calibrator uses an iterative approach to find a minimum least squared error solution.
To use this calibrator at least 3 measurements at different known frames must be provided. In other words, magnetometer samples must be obtained at 3 different positions or orientations. Notice that frame velocities are ignored by this calibrator.
Measured magnetic flux density is assumed to follow the model shown below:
mBmeas = bm + (I + Mm) * mBtrue + w
Where:
- mBmeas is the measured magnetic flux density. This is a 3x1 vector.
- bm is magnetometer hard-iron bias. Ideally, on a perfect magnetometer,
this should be a 3x1 zero vector.
- I is the 3x3 identity matrix.
- Mm is the 3x3 soft-iron matrix containing cross-couplings and scaling
factors. Ideally, on a perfect magnetometer, this should be a 3x3 zero
matrix.
- mBtrue is ground-truth magnetic flux density. This is a 3x1 vector.
- w is measurement noise. This is a 3x1 vector.-
Field Summary
FieldsModifier and TypeFieldDescriptionprivate static final intNumber of unknowns when common z-axis is assumed for the accelerometer, gyroscope and magnetometer.private booleanThis flag indicates whether z-axis is assumed to be common for accelerometer, gyroscope and magnetometer.static final booleanIndicates whether by default a common z-axis is assumed for the accelerometer, gyroscope and magnetometer.private doubleEstimated chi square value.private intEstimated degrees of freedom of chi square value.private com.irurueta.algebra.MatrixEstimated covariance matrix for estimated parameters.private com.irurueta.algebra.MatrixEstimated magnetometer soft-iron matrix containing scale factors and cross coupling errors.private doubleEstimated mean square error respect to provided measurements.private doubleEstimated probability of finding a smaller chi square value expressed as a value between 0.0 and 1.0.private doubleEstimated measure of quality of estimated fit as a value between 0.0 and 1.0.private doubleEstimated reduced chi square value.private final com.irurueta.numerical.fitting.LevenbergMarquardtMultiVariateFitterLevenberg-Marquardt fitter to find a non-linear solution.private static final intNumber of unknowns for the general case.private doubleX-coordinate of known hard-iron bias.private doubleY-coordinate of known hard-iron bias.private doubleZ-coordinate of known hard-iron bias.private doubleInitial x-y cross coupling error.private doubleInitial x-z cross coupling error.private doubleInitial y-x cross coupling error.private doubleInitial y-z cross coupling error.private doubleInitial z-x cross coupling error.private doubleInitial z-y cross coupling error.private doubleInitial x scaling factor.private doubleInitial y scaling factor.private doubleInitial z scaling factor.Listener to handle events raised by this calibrator.private WorldMagneticModelContains Earth's magnetic model.Contains a collection of body magnetic flux density measurements taken at different frames (positions and orientations) and containing the standard deviation of magnetometer measurements.static final intRequired minimum number of measurements.private booleanIndicates whether calibrator is running. -
Constructor Summary
ConstructorsConstructorDescriptionConstructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double[] hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double[] hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, double[] hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, double[] hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, WorldMagneticModel magneticModel, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double[] hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double[] hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, double[] hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, double[] hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(WorldMagneticModel magneticModel, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double[] hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double[] hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, double[] hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, double[] hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, WorldMagneticModel magneticModel, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double[] hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double[] hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, com.irurueta.algebra.Matrix hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, com.irurueta.algebra.Matrix hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, double[] hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, double[] hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, double hardIronX, double hardIronY, double hardIronZ, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, com.irurueta.algebra.Matrix hardIron, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor.KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, WorldMagneticModel magneticModel, KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener listener) Constructor. -
Method Summary
Modifier and TypeMethodDescriptionvoidEstimates magnetometer calibration parameters containing scale factors and cross-coupling errors.private voidInternal method to perform calibration when common z-axis is assumed for both the accelerometer and gyroscope.private voidInternal method to perform general calibration.private static doubleconvertMagneticFluxDensity(double value, com.irurueta.units.MagneticFluxDensityUnit unit) Converts magnetic flux density value and unit to Teslas.private static doubleconvertMagneticFluxDensity(com.irurueta.units.MagneticFluxDensity magneticFluxDensity) Converts magnetic flux density instance to Teslas.doubleGets estimated chi square value.intGets estimated chi square degrees of freedom.com.irurueta.algebra.MatrixGets estimated covariance matrix for estimated calibration parameters.com.irurueta.algebra.MatrixGets estimated magnetometer soft-iron matrix containing scale factors and cross coupling errors.doubleGets 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.doubleGets estimated probability of finding a smaller chi square value expressed as a value between 0.0 and 1.0.doubleGets estimated measure of quality of estimated fit as a value between 0.0 and 1.0.doubleGets estimated reduced chi square value.Gets estimated x-axis scale factor.Gets estimated y-axis scale factor.Gets estimated z-axis scale factor.double[]Gets known hard-iron bias as an array.voidgetHardIron(double[] result) Gets known hard-iron bias as an array.Gets known hard-iron.voidGets known hard-iron.com.irurueta.algebra.MatrixGets known hard-iron bias as a column matrix.voidgetHardIronMatrix(com.irurueta.algebra.Matrix result) Gets known hard-iron bias as a column matrix.doubleGets x-coordinate of known magnetometer hard-iron bias.com.irurueta.units.MagneticFluxDensityGets known x coordinate of magnetometer hard-iron.voidgetHardIronXAsMagneticFluxDensity(com.irurueta.units.MagneticFluxDensity result) Gets known x coordinate of magnetometer hard-iron.doubleGets y-coordinate of known magnetometer hard-iron bias.com.irurueta.units.MagneticFluxDensityGets known y coordinate of magnetometer hard-iron.voidgetHardIronYAsMagneticFluxDensity(com.irurueta.units.MagneticFluxDensity result) Gets known y coordinate of magnetometer hard-iron.doubleGets z-coordinate of known magnetometer hard-iron bias.com.irurueta.units.MagneticFluxDensityGets known z coordinate of magnetometer hard-iron.voidgetHardIronZAsMagneticFluxDensity(com.irurueta.units.MagneticFluxDensity result) Gets known z coordinate of magnetometer hard-iron.com.irurueta.algebra.MatrixGets initial scale factors and cross coupling errors matrix.voidgetInitialMm(com.irurueta.algebra.Matrix result) Gets initial scale factors and cross coupling errors matrix.doubleGets initial x-y cross coupling error.doubleGets initial x-z cross coupling error.doubleGets initial y-x cross coupling error.doubleGets initial y-z cross coupling error.doubleGets initial z-x cross coupling error.doubleGets initial z-y cross coupling error.doubleGets initial x scaling factor.doubleGets initial y scaling factor.doubleGets initial z scaling factor.Gets listener to handle events raised by this calibrator.Gets Earth's magnetic model.Gets a collection of body magnetic flux density measurements taken at different frames (positions, orientations and velocities).Indicates the type of measurement used by this calibrator.intGets minimum number of required measurements.booleanIndicates whether z-axis is assumed to be common for accelerometer, gyroscope and magnetometer.booleanIndicates whether this calibrator requires ordered measurements in a list or not.booleanIndicates whether this calibrator requires quality scores for each measurement or not.booleanisReady()Indicates whether calibrator is ready to start the estimator.booleanIndicates whether calibrator is currently running or no.voidsetCommonAxisUsed(boolean commonAxisUsed) Specifies whether z-axis is assumed to be common for accelerometer and gyroscope.voidsetHardIron(double[] hardIron) Sets known hard-iron bias as an array.voidsetHardIron(com.irurueta.algebra.Matrix hardIron) Sets known hard-iron bias.voidsetHardIron(MagneticFluxDensityTriad hardIron) Sets known hard-iron.voidsetHardIronCoordinates(double hardIronX, double hardIronY, double hardIronZ) Sets known hard-iron bias coordinates of magnetometer expressed in Teslas (T).voidsetHardIronCoordinates(com.irurueta.units.MagneticFluxDensity hardIronX, com.irurueta.units.MagneticFluxDensity hardIronY, com.irurueta.units.MagneticFluxDensity hardIronZ) Sets known hard-iron coordinates.voidsetHardIronX(double hardIronX) Sets x-coordinate of known magnetometer hard-iron bias.voidsetHardIronX(com.irurueta.units.MagneticFluxDensity hardIronX) Sets known x-coordinate of magnetometer hard-iron.voidsetHardIronY(double hardIronY) Sets y-coordinate of known magnetometer hard-iron bias.voidsetHardIronY(com.irurueta.units.MagneticFluxDensity hardIronY) Sets known y-coordinate of magnetometer hard-iron.voidsetHardIronZ(double hardIronZ) Sets z-coordinate of known magnetometer hard-iron bias.voidsetHardIronZ(com.irurueta.units.MagneticFluxDensity hardIronZ) Sets known z-coordinate of magnetometer hard-iron.voidsetInitialCrossCouplingErrors(double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Sets initial cross coupling errors.voidsetInitialMm(com.irurueta.algebra.Matrix initialMm) Sets initial scale factors and cross coupling errors matrix.voidsetInitialMxy(double initialMxy) Sets initial x-y cross coupling error.voidsetInitialMxz(double initialMxz) Sets initial x-z cross coupling error.voidsetInitialMyx(double initialMyx) Sets initial y-x cross coupling error.voidsetInitialMyz(double initialMyz) Sets initial y-z cross coupling error.voidsetInitialMzx(double initialMzx) Sets initial z-x cross coupling error.voidsetInitialMzy(double initialMzy) Sets initial z-y cross coupling error.voidsetInitialScalingFactors(double initialSx, double initialSy, double initialSz) Sets initial scaling factors.voidsetInitialScalingFactorsAndCrossCouplingErrors(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.voidsetInitialSx(double initialSx) Sets initial x scaling factor.voidsetInitialSy(double initialSy) Sets initial y scaling factor.voidsetInitialSz(double initialSz) Sets initial z scaling factor.private voidSets input data into Levenberg-Marquardt fitter.voidSets listener to handle events raised by this calibrator.voidsetMagneticModel(WorldMagneticModel magneticModel) Sets Earth's magnetic model.voidsetMeasurements(Collection<? extends StandardDeviationFrameBodyMagneticFluxDensity> measurements) Sets a collection of body magnetic flux density measurements taken at different frames (positions, orientations and velocities).
-
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 the accelerometer, gyroscope and magnetometer.- See Also:
-
MINIMUM_MEASUREMENTS
public static final int MINIMUM_MEASUREMENTSRequired minimum number of measurements.- See Also:
-
COMMON_Z_AXIS_UNKNOWNS
private static final int COMMON_Z_AXIS_UNKNOWNSNumber of unknowns when common z-axis is assumed for the accelerometer, gyroscope and magnetometer.- See Also:
-
GENERAL_UNKNOWNS
private static final int GENERAL_UNKNOWNSNumber of unknowns for the general case.- See Also:
-
fitter
private final com.irurueta.numerical.fitting.LevenbergMarquardtMultiVariateFitter fitterLevenberg-Marquardt fitter to find a non-linear solution. -
hardIronX
private double hardIronXX-coordinate of known hard-iron bias. This is expressed in Teslas (T). -
hardIronY
private double hardIronYY-coordinate of known hard-iron bias. This is expressed in Teslas (T). -
hardIronZ
private double hardIronZZ-coordinate of known hard-iron bias. This is expressed in Teslas (T). -
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. -
measurements
Contains a collection of body magnetic flux density measurements taken at different frames (positions and orientations) and containing the standard deviation of magnetometer measurements. If a single device magnetometer needs to be calibrated, typically all measurements are taken at the same position, with zero velocity and multiple orientations. However, if we just want to calibrate a given magnetometer model (e.g. obtain an average and less precise calibration for the magnetometer of a given phone model), we could take measurements collected throughout the planet at multiple positions while the phone remains static (e.g. while charging), hence each measurement position will change, velocity will remain zero and orientation will be typically constant at horizontal orientation while the phone remains on a flat surface. -
commonAxisUsed
private boolean commonAxisUsedThis flag indicates whether z-axis is assumed to be common for accelerometer, gyroscope and magnetometer. When enabled, this eliminates 3 variables from Mm matrix. -
listener
Listener to handle events raised by this calibrator. -
estimatedMm
private com.irurueta.algebra.Matrix estimatedMmEstimated magnetometer soft-iron matrix containing scale factors and cross coupling errors. This is the product of matrix Tm containing cross coupling errors and Km containing scaling factors. So tat:Mm = [sx mxy mxz] = Tm*Km [myx sy myz] [mzx mzy sz ]Where:Km = [sx 0 0 ] [0 sy 0 ] [0 0 sz]andTm = [1 -alphaXy alphaXz ] [alphaYx 1 -alphaYz] [-alphaZx alphaZy 1 ]Hence:Mm = [sx mxy mxz] = Tm*Km = [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 Mm matrix becomes upper diagonal:Mm = [sx mxy mxz] [0 sy myz] [0 0 sz ]Values of this matrix are unit-less. -
estimatedCovariance
private com.irurueta.algebra.Matrix estimatedCovarianceEstimated covariance matrix for estimated parameters. -
estimatedChiSq
private double estimatedChiSqEstimated chi square value. -
estimatedChiSqDegreesOfFreedom
private int estimatedChiSqDegreesOfFreedomEstimated degrees of freedom of chi square value. Degrees of freedom is equal to the number of sampled data minus the number of estimated parameters. -
estimatedReducedChiSq
private double estimatedReducedChiSqEstimated reduced chi square value. This is equal to estimated chi square value divided by its degrees of freedom. Ideally this value should be close to 1.0. -
estimatedMse
private double estimatedMseEstimated mean square error respect to provided measurements. -
estimatedP
private double estimatedPEstimated probability of finding a smaller chi square value expressed as a value between 0.0 and 1.0. The smaller the found chi square value is, the better the fit of the estimated parameters to the actual parameter. Thus, the smaller the chance of finding a smaller chi square value, then the better the estimated fit is. -
estimatedQ
private double estimatedQEstimated measure of quality of estimated fit as a value between 0.0 and 1.0. The larger the quality value is, the better the fit that has been estimated. -
running
private boolean runningIndicates whether calibrator is running. -
magneticModel
Contains Earth's magnetic model.
-
-
Constructor Details
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator()Constructor. -
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed) Constructor.- Parameters:
commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ) Constructor.- Parameters:
hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ) Constructor.- Parameters:
commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.- Parameters:
hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).initialSx- initial x scaling factor.initialSy- initial y scaling factor.initialSz- initial z scaling factor.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).initialSx- initial x scaling factor.initialSy- initial y scaling factor.initialSz- initial z scaling factor.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.- Parameters:
commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).initialSx- initial x scaling factor.initialSy- initial y scaling factor.initialSz- initial z scaling factor.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).initialSx- initial x scaling factor.initialSy- initial y scaling factor.initialSz- initial z scaling factor.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.- Parameters:
hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).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.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).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.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.- Parameters:
commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).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.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double hardIronX, double hardIronY, double hardIronZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIronX- x-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronY- y-coordinate of magnetometer hard-iron bias expressed in Teslas (T).hardIronZ- z-coordinate of magnetometer hard-iron bias expressed in Teslas (T).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.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(double[] hardIron) Constructor.- Parameters:
hardIron- known hard-iron.- Throws:
IllegalArgumentException- if provided hard-iron array does not have length 3.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, double[] hardIron) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).hardIron- known hard-iron.- Throws:
IllegalArgumentException- if provided hard-iron array does not have length 3.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double[] hardIron) Constructor.- Parameters:
commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIron- known hard-iron.- Throws:
IllegalArgumentException- if provided hard-iron array does not have length 3.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, double[] hardIron) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIron- known hard-iron.- Throws:
IllegalArgumentException- if provided hard-iron array does not have length 3.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix hardIron) Constructor.- Parameters:
hardIron- known hard-iron.- Throws:
IllegalArgumentException- if provided hard-iron matrix is not 3x1.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, com.irurueta.algebra.Matrix hardIron) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).hardIron- known hard-iron.- Throws:
IllegalArgumentException- if provided hard-iron matrix is not 3x1.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron) Constructor.- Parameters:
commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIron- known hard-iron.- Throws:
IllegalArgumentException- if provided hard-iron matrix is not 3x1.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIron- known hard-iron.- Throws:
IllegalArgumentException- if provided hard-iron matrix is not 3x1.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.- Parameters:
hardIron- known hard-iron.initialMm- initial soft-iron matrix containing scale factors and cross coupling errors.- Throws:
IllegalArgumentException- if provided hard-iron matrix is not 3x1 or if soft-iron matrix is not 3x3.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).hardIron- known hard-iron.initialMm- initial soft-iron matrix containing scale factors and cross coupling errors.- Throws:
IllegalArgumentException- if provided hard-iron matrix is not 3x1 or if soft-iron matrix is not 3x3.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.- Parameters:
commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIron- known hard-iron.initialMm- initial soft-iron matrix containing scale factors and cross coupling errors.- Throws:
IllegalArgumentException- if provided hard-iron matrix is not 3x1 or if soft-iron matrix is not 3x3.
-
KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator
public KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyMagneticFluxDensity> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix initialMm) Constructor.- Parameters:
measurements- collection of body magnetic flux density measurements with standard deviations taken at different frames (positions and orientations).commonAxisUsed- indicates whether z-axis is assumed to be common for the accelerometer, gyroscope and magnetometer.hardIron- known hard-iron.initialMm- initial soft-iron matrix containing scale factors and cross coupling errors.- Throws:
IllegalArgumentException- if provided hard-iron matrix is not 3x1 or if soft-iron matrix is not 3x3.
-
-
Method Details
-
getHardIronX
public double getHardIronX()Gets x-coordinate of known magnetometer hard-iron bias. This is expressed in Teslas (T).- Specified by:
getHardIronXin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- x-coordinate of known magnetometer hard-iron bias.
-
setHardIronX
public void setHardIronX(double hardIronX) throws com.irurueta.navigation.LockedException Sets x-coordinate of known magnetometer hard-iron bias. This is expressed in Teslas (T).- Specified by:
setHardIronXin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIronX- x coordinate of magnetometer hard-iron.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.
-
getHardIronY
public double getHardIronY()Gets y-coordinate of known magnetometer hard-iron bias. This is expressed in Teslas (T).- Specified by:
getHardIronYin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- y-coordinate of known magnetometer hard-iron bias.
-
setHardIronY
public void setHardIronY(double hardIronY) throws com.irurueta.navigation.LockedException Sets y-coordinate of known magnetometer hard-iron bias. This is expressed in Teslas (T).- Specified by:
setHardIronYin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIronY- y coordinate of magnetometer hard-iron.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.
-
getHardIronZ
public double getHardIronZ()Gets z-coordinate of known magnetometer hard-iron bias. This is expressed in Teslas (T).- Specified by:
getHardIronZin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- z-coordinate of known magnetometer hard-iron bias.
-
setHardIronZ
public void setHardIronZ(double hardIronZ) throws com.irurueta.navigation.LockedException Sets z-coordinate of known magnetometer hard-iron bias. This is expressed in Teslas (T).- Specified by:
setHardIronZin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIronZ- z coordinate of magnetometer hard-iron.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.
-
getHardIronXAsMagneticFluxDensity
public com.irurueta.units.MagneticFluxDensity getHardIronXAsMagneticFluxDensity()Gets known x coordinate of magnetometer hard-iron.- Specified by:
getHardIronXAsMagneticFluxDensityin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- x coordinate of magnetometer hard-iron.
-
getHardIronXAsMagneticFluxDensity
public void getHardIronXAsMagneticFluxDensity(com.irurueta.units.MagneticFluxDensity result) Gets known x coordinate of magnetometer hard-iron.- Specified by:
getHardIronXAsMagneticFluxDensityin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
result- instance where result will be stored.
-
setHardIronX
public void setHardIronX(com.irurueta.units.MagneticFluxDensity hardIronX) throws com.irurueta.navigation.LockedException Sets known x-coordinate of magnetometer hard-iron.- Specified by:
setHardIronXin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIronX- known x-coordinate of magnetometer hard-iron.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.
-
getHardIronYAsMagneticFluxDensity
public com.irurueta.units.MagneticFluxDensity getHardIronYAsMagneticFluxDensity()Gets known y coordinate of magnetometer hard-iron.- Specified by:
getHardIronYAsMagneticFluxDensityin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- y coordinate of magnetometer hard-iron.
-
getHardIronYAsMagneticFluxDensity
public void getHardIronYAsMagneticFluxDensity(com.irurueta.units.MagneticFluxDensity result) Gets known y coordinate of magnetometer hard-iron.- Specified by:
getHardIronYAsMagneticFluxDensityin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
result- instance where result will be stored.
-
setHardIronY
public void setHardIronY(com.irurueta.units.MagneticFluxDensity hardIronY) throws com.irurueta.navigation.LockedException Sets known y-coordinate of magnetometer hard-iron.- Specified by:
setHardIronYin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIronY- known y-coordinate of magnetometer hard-iron.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.
-
getHardIronZAsMagneticFluxDensity
public com.irurueta.units.MagneticFluxDensity getHardIronZAsMagneticFluxDensity()Gets known z coordinate of magnetometer hard-iron.- Specified by:
getHardIronZAsMagneticFluxDensityin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- z coordinate of magnetometer hard-iron.
-
getHardIronZAsMagneticFluxDensity
public void getHardIronZAsMagneticFluxDensity(com.irurueta.units.MagneticFluxDensity result) Gets known z coordinate of magnetometer hard-iron.- Specified by:
getHardIronZAsMagneticFluxDensityin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
result- instance where result will be stored.
-
setHardIronZ
public void setHardIronZ(com.irurueta.units.MagneticFluxDensity hardIronZ) throws com.irurueta.navigation.LockedException Sets known z-coordinate of magnetometer hard-iron.- Specified by:
setHardIronZin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIronZ- known z-coordinate of magnetometer hard-iron.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.
-
setHardIronCoordinates
public void setHardIronCoordinates(double hardIronX, double hardIronY, double hardIronZ) throws com.irurueta.navigation.LockedException Sets known hard-iron bias coordinates of magnetometer expressed in Teslas (T).- Specified by:
setHardIronCoordinatesin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIronX- x-coordinate of magnetometer hard-iron.hardIronY- y-coordinate of magnetometer hard-iron.hardIronZ- z-coordinate of magnetometer hard-iron.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.
-
setHardIronCoordinates
public void setHardIronCoordinates(com.irurueta.units.MagneticFluxDensity hardIronX, com.irurueta.units.MagneticFluxDensity hardIronY, com.irurueta.units.MagneticFluxDensity hardIronZ) throws com.irurueta.navigation.LockedException Sets known hard-iron coordinates.- Specified by:
setHardIronCoordinatesin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIronX- x-coordinate of magnetometer hard-iron.hardIronY- y-coordinate of magnetometer hard-iron.hardIronZ- z-coordinate of magnetometer hard-iron.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.
-
getHardIronAsTriad
Gets known hard-iron.- Specified by:
getHardIronAsTriadin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- known hard-iron.
-
getInitialSx
public double getInitialSx()Gets initial x scaling factor.- Specified by:
getInitialSxin interfaceMagnetometerNonLinearCalibrator- Returns:
- initial x scaling factor.
-
setInitialSx
public void setInitialSx(double initialSx) throws com.irurueta.navigation.LockedException Sets initial x scaling factor.- Specified by:
setInitialSxin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
getInitialSyin interfaceMagnetometerNonLinearCalibrator- Returns:
- initial y scaling factor.
-
setInitialSy
public void setInitialSy(double initialSy) throws com.irurueta.navigation.LockedException Sets initial y scaling factor.- Specified by:
setInitialSyin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
getInitialSzin interfaceMagnetometerNonLinearCalibrator- Returns:
- initial z scaling factor.
-
setInitialSz
public void setInitialSz(double initialSz) throws com.irurueta.navigation.LockedException Sets initial z scaling factor.- Specified by:
setInitialSzin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
getInitialMxyin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialMxyin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
getInitialMxzin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialMxzin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
getInitialMyxin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialMyxin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
getInitialMyzin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialMyzin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
getInitialMzxin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialMzxin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
getInitialMzyin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialMzyin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialScalingFactorsin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialCrossCouplingErrorsin interfaceMagnetometerNonLinearCalibrator- 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.- Specified by:
setInitialScalingFactorsAndCrossCouplingErrorsin interfaceMagnetometerNonLinearCalibrator- 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.
-
getHardIron
public double[] getHardIron()Gets known hard-iron bias as an array. Array values are expressed in Teslas (T).- Specified by:
getHardIronin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- array containing coordinates of initial bias.
-
getHardIron
public void getHardIron(double[] result) Gets known hard-iron bias as an array. Array values are expressed in Teslas (T).- Specified by:
getHardIronin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
result- instance where result data will be copied to.- Throws:
IllegalArgumentException- if provided array does not have length 3.
-
setHardIron
public void setHardIron(double[] hardIron) throws com.irurueta.navigation.LockedException Sets known hard-iron bias as an array. Array values are expressed in Teslas (T).- Specified by:
setHardIronin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIron- known hard-iron bias.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.IllegalArgumentException- if provided array does not have length 3.
-
getHardIronMatrix
public com.irurueta.algebra.Matrix getHardIronMatrix()Gets known hard-iron bias as a column matrix.- Specified by:
getHardIronMatrixin interfaceKnownHardIronMagnetometerCalibrator- Returns:
- hard-iron bias as a column matrix.
-
getHardIronMatrix
public void getHardIronMatrix(com.irurueta.algebra.Matrix result) Gets known hard-iron bias as a column matrix.- Specified by:
getHardIronMatrixin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
result- instance where result data will be copied to.- Throws:
IllegalArgumentException- if provided matrix is not 3x1.
-
setHardIron
public void setHardIron(com.irurueta.algebra.Matrix hardIron) throws com.irurueta.navigation.LockedException Sets known hard-iron bias.- Specified by:
setHardIronin interfaceKnownHardIronMagnetometerCalibrator- Parameters:
hardIron- magnetometer hard-iron bias to be set.- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.IllegalArgumentException- if provided matrix is not 3x1.
-
getInitialMm
public com.irurueta.algebra.Matrix getInitialMm()Gets initial scale factors and cross coupling errors matrix.- Specified by:
getInitialMmin interfaceMagnetometerNonLinearCalibrator- Returns:
- initial scale factors and cross coupling errors matrix.
-
getInitialMm
public void getInitialMm(com.irurueta.algebra.Matrix result) Gets initial scale factors and cross coupling errors matrix.- Specified by:
getInitialMmin interfaceMagnetometerNonLinearCalibrator- Parameters:
result- instance where data will be stored.- Throws:
IllegalArgumentException- if provided matrix is not 3x3.
-
setInitialMm
public void setInitialMm(com.irurueta.algebra.Matrix initialMm) throws com.irurueta.navigation.LockedException Sets initial scale factors and cross coupling errors matrix.- Specified by:
setInitialMmin interfaceMagnetometerNonLinearCalibrator- Parameters:
initialMm- 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.
-
getMeasurements
Gets a collection of body magnetic flux density measurements taken at different frames (positions, orientations and velocities). If a single device IMU needs to be calibrated, typically all measurements are taken at the same position, with zero velocity and multiple orientations. However, if we just want to calibrate a given IMU model (e.g. obtain an average and less precise calibration for the IMU of a given phone model), we could take measurements collected throughout the planet at multiple positions while the phone remains static (e.g. while charging), hence each measurement position will change, velocity will remain zero and orientation will be typically constant at horizontal orientation while the phone remains on a flat surface.- Specified by:
getMeasurementsin interfaceKnownHardIronAndFrameMagnetometerCalibrator<StandardDeviationFrameBodyMagneticFluxDensity,KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener> - Specified by:
getMeasurementsin interfaceUnorderedStandardDeviationFrameBodyMagneticFluxDensityMagnetometerCalibrator- Returns:
- a collection of body magnetic flux density measurements taken at different frames (positions, orientations and velocities).
-
setMeasurements
public void setMeasurements(Collection<? extends StandardDeviationFrameBodyMagneticFluxDensity> measurements) throws com.irurueta.navigation.LockedException Sets a collection of body magnetic flux density measurements taken at different frames (positions, orientations and velocities). If a single device IMU needs to be calibrated, typically all measurements are taken at the same position, with zero velocity and multiple orientations. However, if we just want to calibrate the a given IMU model (e.g. obtain an average and less precise calibration for the IMU of a given phone model), we could take measurements collected throughout the planet at multiple positions while the phone remains static (e.g. while charging), hence each measurement position will change, velocity will remain zero and orientation will be typically constant at horizontal orientation while the phone remains on a flat surface.- Specified by:
setMeasurementsin interfaceKnownHardIronAndFrameMagnetometerCalibrator<StandardDeviationFrameBodyMagneticFluxDensity,KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener> - Specified by:
setMeasurementsin interfaceUnorderedStandardDeviationFrameBodyMagneticFluxDensityMagnetometerCalibrator- Parameters:
measurements- collection of body magnetic flux density measurements taken at different frames (positions, orientations and velocities).- Throws:
com.irurueta.navigation.LockedException- if estimator is currently running.
-
getMeasurementType
Indicates the type of measurement used by this calibrator.- Specified by:
getMeasurementTypein interfaceMagnetometerCalibrator- 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:
isOrderedMeasurementsRequiredin interfaceMagnetometerCalibrator- Returns:
- true if measurements must be ordered, false otherwise.
-
isQualityScoresRequired
public boolean isQualityScoresRequired()Indicates whether this calibrator requires quality scores for each measurement or not.- Specified by:
isQualityScoresRequiredin interfaceMagnetometerCalibrator- Returns:
- true if quality scores are required, false otherwise.
-
isCommonAxisUsed
public boolean isCommonAxisUsed()Indicates whether z-axis is assumed to be common for accelerometer, gyroscope and magnetometer. When enabled, this eliminates 3 variables from Mm (soft-iron) matrix.- Specified by:
isCommonAxisUsedin interfaceMagnetometerCalibrator- Returns:
- true if z-axis is assumed to be common for accelerometer, gyroscope and magnetometer, 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 Mm matrix.- Specified by:
setCommonAxisUsedin interfaceMagnetometerCalibrator- Parameters:
commonAxisUsed- true if z-axis is assumed to be common for accelerometer, gyroscope and magnetometer, false otherwise.- Throws:
com.irurueta.navigation.LockedException- if estimator is currently running.
-
getListener
Gets listener to handle events raised by this calibrator.- Specified by:
getListenerin interfaceKnownHardIronAndFrameMagnetometerCalibrator<StandardDeviationFrameBodyMagneticFluxDensity,KnownHardIronAndFrameMagnetometerNonLinearLeastSquaresCalibratorListener> - Returns:
- listener to handle events raised by this calibrator.
-
getMinimumRequiredMeasurements
public int getMinimumRequiredMeasurements()Gets minimum number of required measurements.- Specified by:
getMinimumRequiredMeasurementsin interfaceMagnetometerCalibrator- Returns:
- minimum number of required measurements.
-
isReady
public boolean isReady()Indicates whether calibrator is ready to start the estimator.- Specified by:
isReadyin interfaceMagnetometerCalibrator- Returns:
- true if calibrator is ready, false otherwise.
-
isRunning
public boolean isRunning()Indicates whether calibrator is currently running or no.- Specified by:
isRunningin interfaceMagnetometerCalibrator- Returns:
- true if calibrator is running, false otherwise.
-
getMagneticModel
Gets Earth's magnetic model.- Returns:
- Earth's magnetic model or null if not provided.
-
calibrate
public void calibrate() throws com.irurueta.navigation.LockedException, com.irurueta.navigation.NotReadyException, CalibrationExceptionEstimates magnetometer calibration parameters containing scale factors and cross-coupling errors.- Specified by:
calibratein interfaceMagnetometerCalibrator- Throws:
com.irurueta.navigation.LockedException- if calibrator is currently running.com.irurueta.navigation.NotReadyException- if calibrator is not ready.CalibrationException- if calibration fails for numerical reasons.
-
getEstimatedMm
public com.irurueta.algebra.Matrix getEstimatedMm()Gets estimated magnetometer soft-iron matrix containing scale factors and cross coupling errors. This is the product of matrix Tm containing cross coupling errors and Km containing scaling factors. So tat:Mm = [sx mxy mxz] = Tm*Km [myx sy myz] [mzx mzy sz ]Where:Km = [sx 0 0 ] [0 sy 0 ] [0 0 sz]andTm = [1 -alphaXy alphaXz ] [alphaYx 1 -alphaYz] [-alphaZx alphaZy 1 ]Hence:Mm = [sx mxy mxz] = Tm*Km = [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 Mm matrix becomes upper diagonal:Mm = [sx mxy mxz] [0 sy myz] [0 0 sz ]Values of this matrix are unit-less.- Specified by:
getEstimatedMmin interfaceMagnetometerCalibrator- Returns:
- estimated magnetometer soft-iron scale factors and cross coupling errors, or null if not available.
-
getEstimatedSx
Gets estimated x-axis scale factor.- Specified by:
getEstimatedSxin interfaceMagnetometerCalibrator- Returns:
- estimated x-axis scale factor or null if not available.
-
getEstimatedSy
Gets estimated y-axis scale factor.- Specified by:
getEstimatedSyin interfaceMagnetometerCalibrator- Returns:
- estimated y-axis scale factor or null if not available.
-
getEstimatedSz
Gets estimated z-axis scale factor.- Specified by:
getEstimatedSzin interfaceMagnetometerCalibrator- Returns:
- estimated z-axis scale factor or null if not available.
-
getEstimatedMxy
Gets estimated x-y cross-coupling error.- Specified by:
getEstimatedMxyin interfaceMagnetometerCalibrator- Returns:
- estimated x-y cross-coupling error or null if not available.
-
getEstimatedMxz
Gets estimated x-z cross-coupling error.- Specified by:
getEstimatedMxzin interfaceMagnetometerCalibrator- Returns:
- estimated x-z cross-coupling error or null if not available.
-
getEstimatedMyx
Gets estimated y-x cross-coupling error.- Specified by:
getEstimatedMyxin interfaceMagnetometerCalibrator- Returns:
- estimated y-x cross-coupling error or null if not available.
-
getEstimatedMyz
Gets estimated y-z cross-coupling error.- Specified by:
getEstimatedMyzin interfaceMagnetometerCalibrator- Returns:
- estimated y-z cross-coupling error or null if not available.
-
getEstimatedMzx
Gets estimated z-x cross-coupling error.- Specified by:
getEstimatedMzxin interfaceMagnetometerCalibrator- Returns:
- estimated z-x cross-coupling error or null if not available.
-
getEstimatedMzy
Gets estimated z-y cross-coupling error.- Specified by:
getEstimatedMzyin interfaceMagnetometerCalibrator- 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 parameters. Diagonal elements of the matrix contains variance for the following parameters (following indicated order): sx, sy, sz, mxy, mxz, myx, myz, mzx, mzy.- Specified by:
getEstimatedCovariancein interfaceMagnetometerNonLinearCalibrator- Returns:
- estimated covariance matrix for estimated position.
-
getEstimatedChiSq
public double getEstimatedChiSq()Gets estimated chi square value.- Specified by:
getEstimatedChiSqin interfaceMagnetometerNonLinearCalibrator- Returns:
- estimated chi square value.
-
getEstimatedChiSqDegreesOfFreedom
public int getEstimatedChiSqDegreesOfFreedom()Gets estimated chi square degrees of freedom. Degrees of freedom is equal to the number of sampled data minus the number of estimated parameters.- Specified by:
getEstimatedChiSqDegreesOfFreedomin interfaceMagnetometerNonLinearCalibrator- Returns:
- estimated degrees of freedom of chi square value
-
getEstimatedReducedChiSq
public double getEstimatedReducedChiSq()Gets estimated reduced chi square value. This is equal to estimated chi square value divided by its degrees of freedom. Ideally this value should be close to 1.0, indicating that fit is optimal. A value larger than 1.0 indicates that fit is not good or noise has been underestimated, and a value smaller than 1.0 indicates that there is overfitting or noise has been overestimated.- Specified by:
getEstimatedReducedChiSqin interfaceMagnetometerNonLinearCalibrator- Returns:
- estimated reduced chi square value
-
getEstimatedMse
public double getEstimatedMse()Gets estimated mean square error respect to provided measurements.- Specified by:
getEstimatedMsein interfaceMagnetometerNonLinearCalibrator- Returns:
- estimated mean square error respect to provided measurements.
-
getEstimatedP
public double getEstimatedP()Gets estimated probability of finding a smaller chi square value expressed as a value between 0.0 and 1.0. The smaller the found chi square value is, the better the fit of the estimated parameters to the actual parameter. Thus, the smaller the chance of finding a smaller chi square value, then the better the estimated fit is.- Specified by:
getEstimatedPin interfaceMagnetometerNonLinearCalibrator- Returns:
- estimated probability of finding a smaller chi square value.
-
getEstimatedQ
public double getEstimatedQ()Gets estimated measure of quality of estimated fit as a value between 0.0 and 1.0. The larger the quality value is, the better the fit that has been estimated.- Specified by:
getEstimatedQin interfaceMagnetometerNonLinearCalibrator- Returns:
- estimated measure of quality of estimated fit.
-
calibrateCommonAxis
private void calibrateCommonAxis() throws com.irurueta.algebra.AlgebraException, com.irurueta.numerical.fitting.FittingException, com.irurueta.numerical.NotReadyException, IOExceptionInternal method to perform calibration when common z-axis is assumed for both the accelerometer and gyroscope.- Throws:
com.irurueta.algebra.AlgebraException- if there are numerical errors.com.irurueta.numerical.fitting.FittingException- if no convergence to solution is found.com.irurueta.numerical.NotReadyException- if fitter is not ready.IOException- if world magnetic model cannot be loaded.
-
calibrateGeneral
private void calibrateGeneral() throws com.irurueta.algebra.AlgebraException, com.irurueta.numerical.fitting.FittingException, com.irurueta.numerical.NotReadyException, IOExceptionInternal method to perform general calibration.- Throws:
com.irurueta.algebra.AlgebraException- if there are numerical errors.com.irurueta.numerical.fitting.FittingException- if no convergence to solution is found.com.irurueta.numerical.NotReadyException- if fitter is not ready.IOException- if world magnetic model cannot be loaded.
-
setInputData
Sets input data into Levenberg-Marquardt fitter.- Throws:
com.irurueta.algebra.WrongSizeException- never happens.IOException- if world magnetic model cannot be loaded.
-
convertMagneticFluxDensity
private static double convertMagneticFluxDensity(double value, com.irurueta.units.MagneticFluxDensityUnit unit) Converts magnetic flux density value and unit to Teslas.- Parameters:
value- magnetic flux density value.unit- unit of magnetic flux density value.- Returns:
- converted value.
-
convertMagneticFluxDensity
private static double convertMagneticFluxDensity(com.irurueta.units.MagneticFluxDensity magneticFluxDensity) Converts magnetic flux density instance to Teslas.- Parameters:
magneticFluxDensity- magnetic flux density instance to be converted.- Returns:
- converted value.
-