Class RobustKnownBiasAndPositionAccelerometerCalibrator

java.lang.Object
com.irurueta.navigation.inertial.calibration.accelerometer.RobustKnownBiasAndPositionAccelerometerCalibrator
All Implemented Interfaces:
AccelerometerCalibrator, AccelerometerNonLinearCalibrator, KnownBiasAccelerometerCalibrator, OrderedStandardDeviationBodyKinematicsAccelerometerCalibrator, QualityScoredAccelerometerCalibrator
Direct Known Subclasses:
LMedSRobustKnownBiasAndPositionAccelerometerCalibrator, MSACRobustKnownBiasAndPositionAccelerometerCalibrator, PROMedSRobustKnownBiasAndPositionAccelerometerCalibrator, PROSACRobustKnownBiasAndPositionAccelerometerCalibrator, RANSACRobustKnownBiasAndPositionAccelerometerCalibrator

This is an abstract class to robustly estimate accelerometer cross couplings and scaling factors.

To use this calibrator at least 7 measurements taken at a single known position must be taken at 7 different unknown orientations and zero velocity when common z-axis is assumed, otherwise at least 10 measurements are required.

Measured specific force is assumed to follow the model shown below:

     fmeas = ba + (I + Ma) * ftrue + w
 
Where: - fmeas is the measured specific force. This is a 3x1 vector. - ba is accelerometer bias, which is known. This is a 3x1 vector. - I is the 3x3 identity matrix. - Ma is the 3x3 matrix containing cross-couplings and scaling factors. Ideally, on a perfect accelerometer, this should be a 3x3 zero matrix. - ftrue is ground-truth specific force. - w is measurement noise.
  • Field Details

    • DEFAULT_USE_COMMON_Z_AXIS

      public static final boolean DEFAULT_USE_COMMON_Z_AXIS
      Indicates whether by default a common z-axis is assumed for both the accelerometer and gyroscope.
      See Also:
    • MINIMUM_MEASUREMENTS_COMMON_Z_AXIS

      public static final int MINIMUM_MEASUREMENTS_COMMON_Z_AXIS
      Required minimum number of measurements when common z-axis is assumed.
      See Also:
    • MINIMUM_MEASUREMENTS_GENERAL

      public static final int MINIMUM_MEASUREMENTS_GENERAL
      Required minimum number of measurements for the general case.
      See Also:
    • DEFAULT_ROBUST_METHOD

      public static final com.irurueta.numerical.robust.RobustEstimatorMethod DEFAULT_ROBUST_METHOD
      Default robust estimator method when none is provided.
    • DEFAULT_REFINE_RESULT

      public static final boolean DEFAULT_REFINE_RESULT
      Indicates that result is refined by default.
      See Also:
    • DEFAULT_KEEP_COVARIANCE

      public static final boolean DEFAULT_KEEP_COVARIANCE
      Indicates that covariance is kept by default after refining result.
      See Also:
    • DEFAULT_PROGRESS_DELTA

      public static final float DEFAULT_PROGRESS_DELTA
      Default amount of progress variation before notifying a change in estimation progress. By default this is set to 5%.
      See Also:
    • MIN_PROGRESS_DELTA

      public static final float MIN_PROGRESS_DELTA
      Minimum allowed value for progress delta.
      See Also:
    • MAX_PROGRESS_DELTA

      public static final float MAX_PROGRESS_DELTA
      Maximum allowed value for progress delta.
      See Also:
    • DEFAULT_CONFIDENCE

      public static final double DEFAULT_CONFIDENCE
      Constant defining default confidence of the estimated result, which is 99%. This means that with a probability of 99% estimation will be accurate because chosen sub-samples will be inliers.
      See Also:
    • DEFAULT_MAX_ITERATIONS

      public static final int DEFAULT_MAX_ITERATIONS
      Default maximum allowed number of iterations.
      See Also:
    • MIN_CONFIDENCE

      public static final double MIN_CONFIDENCE
      Minimum allowed confidence value.
      See Also:
    • MAX_CONFIDENCE

      public static final double MAX_CONFIDENCE
      Maximum allowed confidence value.
      See Also:
    • MIN_ITERATIONS

      public static final int MIN_ITERATIONS
      Minimum allowed number of iterations.
      See Also:
    • measurements

      protected List<StandardDeviationBodyKinematics> measurements
      Contains a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
    • listener

      Listener to be notified of events such as when calibration starts, ends or its progress significantly changes.
    • running

      protected boolean running
      Indicates whether calibrator is running.
    • progressDelta

      protected float progressDelta
      Amount of progress variation before notifying a progress change during calibration.
    • confidence

      protected double confidence
      Amount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%). The amount of confidence indicates the probability that the estimated result is correct. Usually this value will be close to 1.0, but not exactly 1.0.
    • maxIterations

      protected int maxIterations
      Maximum allowed number of iterations. When the maximum number of iterations is exceeded, result will not be available, however an approximate result will be available for retrieval.
    • inliersData

      protected com.irurueta.numerical.robust.InliersData inliersData
      Data related to inliers found after calibration.
    • refineResult

      protected boolean refineResult
      Indicates whether result must be refined using a non linear calibrator over found inliers. If true, inliers will be computed and kept in any implementation regardless of the settings.
    • preliminarySubsetSize

      protected int preliminarySubsetSize
      Size of subsets to be checked during robust estimation.
    • commonAxisUsed

      private boolean commonAxisUsed
      This flag indicates whether z-axis is assumed to be common for accelerometer and gyroscope. When enabled, this eliminates 3 variables from Ma matrix.
    • biasX

      private double biasX
      X-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
    • biasY

      private double biasY
      Y-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
    • biasZ

      private double biasZ
      Z-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
    • initialSx

      private double initialSx
      Initial x scaling factor.
    • initialSy

      private double initialSy
      Initial y scaling factor.
    • initialSz

      private double initialSz
      Initial z scaling factor.
    • initialMxy

      private double initialMxy
      Initial x-y cross coupling error.
    • initialMxz

      private double initialMxz
      Initial x-z cross coupling error.
    • initialMyx

      private double initialMyx
      Initial y-x cross coupling error.
    • initialMyz

      private double initialMyz
      Initial y-z cross coupling error.
    • initialMzx

      private double initialMzx
      Initial z-x cross coupling error.
    • initialMzy

      private double initialMzy
      Initial z-y cross coupling error.
    • position

      private com.irurueta.navigation.frames.ECEFPosition position
      Position where body kinematics measures have been taken.
    • estimatedMa

      private com.irurueta.algebra.Matrix estimatedMa
      Estimated accelerometer scale factors and cross coupling errors. This is the product of matrix Ta containing cross coupling errors and Ka containing scaling factors. So tat:
           Ma = [sx    mxy  mxz] = Ta*Ka
                [myx   sy   myz]
                [mzx   mzy  sz ]
       
      Where:
           Ka = [sx 0   0 ]
                [0  sy  0 ]
                [0  0   sz]
       
      and
           Ta = [1          -alphaXy    alphaXz ]
                [alphaYx    1           -alphaYz]
                [-alphaZx   alphaZy     1       ]
       
      Hence:
           Ma = [sx    mxy  mxz] = Ta*Ka =  [sx             -sy * alphaXy   sz * alphaXz ]
                [myx   sy   myz]            [sx * alphaYx   sy              -sz * alphaYz]
                [mzx   mzy  sz ]            [-sx * alphaZx  sy * alphaZy    sz           ]
       
      This instance allows any 3x3 matrix however, typically alphaYx, alphaZx and alphaZy are considered to be zero if the accelerometer z-axis is assumed to be the same as the body z-axis. When this is assumed, myx = mzx = mzy = 0 and the Ma matrix becomes upper diagonal:
           Ma = [sx    mxy  mxz]
                [0     sy   myz]
                [0     0    sz ]
       
      Values of this matrix are unit-less.
    • keepCovariance

      private boolean keepCovariance
      Indicates whether covariance must be kept after refining result. This setting is only taken into account if result is refined.
    • estimatedCovariance

      private com.irurueta.algebra.Matrix estimatedCovariance
      Estimated covariance of estimated position. This is only available when result has been refined and covariance is kept.
    • estimatedChiSq

      private double estimatedChiSq
      Estimated chi square value.
    • estimatedMse

      private double estimatedMse
      Estimated mean square error respect to provided measurements.
    • innerCalibrator

      private final KnownBiasAndPositionAccelerometerCalibrator innerCalibrator
      Inner calibrator to compute calibration for each subset of data or during final refining.
    • gravityNorm

      protected double gravityNorm
      Contains gravity norm for current position to be reused during calibration.
    • identity

      protected com.irurueta.algebra.Matrix identity
      Contains 3x3 identify to be reused.
    • tmp1

      protected com.irurueta.algebra.Matrix tmp1
      Contains 3x3 temporary matrix.
    • tmp2

      protected com.irurueta.algebra.Matrix tmp2
      Contains 3x3 temporary matrix.
    • tmp3

      protected com.irurueta.algebra.Matrix tmp3
      Contains 3x1 temporary matrix.
    • tmp4

      protected com.irurueta.algebra.Matrix tmp4
      Contains 3x1 temporary matrix.
  • Constructor Details

    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator()
      Constructor.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(List<StandardDeviationBodyKinematics> measurements)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(boolean commonAxisUsed)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(double[] bias)
      Constructor.
      Parameters:
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.algebra.Matrix bias)
      Constructor.
      Parameters:
      bias - known accelerometer bias.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Constructor.
      Parameters:
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • RobustKnownBiasAndPositionAccelerometerCalibrator

      protected RobustKnownBiasAndPositionAccelerometerCalibrator(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Constructor.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
  • Method Details

    • getBiasX

      public double getBiasX()
      Gets x-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
      Specified by:
      getBiasX in interface KnownBiasAccelerometerCalibrator
      Returns:
      x-coordinate of known accelerometer bias.
    • setBiasX

      public void setBiasX(double biasX) throws com.irurueta.navigation.LockedException
      Sets x-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
      Specified by:
      setBiasX in interface KnownBiasAccelerometerCalibrator
      Parameters:
      biasX - x-coordinate of known accelerometer bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getBiasY

      public double getBiasY()
      Gets y-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
      Specified by:
      getBiasY in interface KnownBiasAccelerometerCalibrator
      Returns:
      y-coordinate of known accelerometer bias.
    • setBiasY

      public void setBiasY(double biasY) throws com.irurueta.navigation.LockedException
      Sets y-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
      Specified by:
      setBiasY in interface KnownBiasAccelerometerCalibrator
      Parameters:
      biasY - y-coordinate of known accelerometer bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getBiasZ

      public double getBiasZ()
      Gets z-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
      Specified by:
      getBiasZ in interface KnownBiasAccelerometerCalibrator
      Returns:
      z-coordinate of known accelerometer bias.
    • setBiasZ

      public void setBiasZ(double biasZ) throws com.irurueta.navigation.LockedException
      Sets z-coordinate of known accelerometer bias. This is expressed in meters per squared second (m/s^2).
      Specified by:
      setBiasZ in interface KnownBiasAccelerometerCalibrator
      Parameters:
      biasZ - z-coordinate of known accelerometer bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getBiasXAsAcceleration

      public com.irurueta.units.Acceleration getBiasXAsAcceleration()
      Gets x-coordinate of known accelerometer bias.
      Specified by:
      getBiasXAsAcceleration in interface KnownBiasAccelerometerCalibrator
      Returns:
      x-coordinate of known accelerometer bias.
    • getBiasXAsAcceleration

      public void getBiasXAsAcceleration(com.irurueta.units.Acceleration result)
      Gets x-coordinate of known accelerometer bias.
      Specified by:
      getBiasXAsAcceleration in interface KnownBiasAccelerometerCalibrator
      Parameters:
      result - instance where result data will be stored.
    • setBiasX

      public void setBiasX(com.irurueta.units.Acceleration biasX) throws com.irurueta.navigation.LockedException
      Sets x-coordinate of known accelerometer bias.
      Specified by:
      setBiasX in interface KnownBiasAccelerometerCalibrator
      Parameters:
      biasX - x-coordinate of known accelerometer bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getBiasYAsAcceleration

      public com.irurueta.units.Acceleration getBiasYAsAcceleration()
      Gets y-coordinate of known accelerometer bias.
      Specified by:
      getBiasYAsAcceleration in interface KnownBiasAccelerometerCalibrator
      Returns:
      y-coordinate of known accelerometer bias.
    • getBiasYAsAcceleration

      public void getBiasYAsAcceleration(com.irurueta.units.Acceleration result)
      Gets y-coordinate of known accelerometer bias.
      Specified by:
      getBiasYAsAcceleration in interface KnownBiasAccelerometerCalibrator
      Parameters:
      result - instance where result data will be stored.
    • setBiasY

      public void setBiasY(com.irurueta.units.Acceleration biasY) throws com.irurueta.navigation.LockedException
      Sets y-coordinate of known accelerometer bias.
      Specified by:
      setBiasY in interface KnownBiasAccelerometerCalibrator
      Parameters:
      biasY - y-coordinate of known accelerometer bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getBiasZAsAcceleration

      public com.irurueta.units.Acceleration getBiasZAsAcceleration()
      Gets z-coordinate of known accelerometer bias.
      Specified by:
      getBiasZAsAcceleration in interface KnownBiasAccelerometerCalibrator
      Returns:
      z-coordinate of known accelerometer bias.
    • getBiasZAsAcceleration

      public void getBiasZAsAcceleration(com.irurueta.units.Acceleration result)
      Gets z-coordinate of known accelerometer bias.
      Specified by:
      getBiasZAsAcceleration in interface KnownBiasAccelerometerCalibrator
      Parameters:
      result - instance where result data will be stored.
    • setBiasZ

      public void setBiasZ(com.irurueta.units.Acceleration biasZ) throws com.irurueta.navigation.LockedException
      Sets z-coordinate of known accelerometer bias to be used to find a solution.
      Specified by:
      setBiasZ in interface KnownBiasAccelerometerCalibrator
      Parameters:
      biasZ - z-coordinate of known accelerometer bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • setBiasCoordinates

      public void setBiasCoordinates(double biasX, double biasY, double biasZ) throws com.irurueta.navigation.LockedException
      Sets known bias coordinates of accelerometer expressed in meters per squared second (m/s^2).
      Specified by:
      setBiasCoordinates in interface KnownBiasAccelerometerCalibrator
      Parameters:
      biasX - x-coordinate of known accelerometer bias.
      biasY - y-coordinate of known accelerometer bias.
      biasZ - z-coordinate of known accelerometer bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • setBiasCoordinates

      public void setBiasCoordinates(com.irurueta.units.Acceleration biasX, com.irurueta.units.Acceleration biasY, com.irurueta.units.Acceleration biasZ) throws com.irurueta.navigation.LockedException
      Sets known bias coordinates of accelerometer.
      Specified by:
      setBiasCoordinates in interface KnownBiasAccelerometerCalibrator
      Parameters:
      biasX - x-coordinate of known accelerometer bias.
      biasY - y-coordinate of known accelerometer bias.
      biasZ - z-coordinate of known accelerometer bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getBiasAsTriad

      public AccelerationTriad getBiasAsTriad()
      Gets known accelerometer bias.
      Specified by:
      getBiasAsTriad in interface KnownBiasAccelerometerCalibrator
      Returns:
      known accelerometer bias.
    • getBiasAsTriad

      public void getBiasAsTriad(AccelerationTriad result)
      Gets known accelerometer bias.
      Specified by:
      getBiasAsTriad in interface KnownBiasAccelerometerCalibrator
      Parameters:
      result - instance where result will be stored.
    • setBias

      public void setBias(AccelerationTriad bias) throws com.irurueta.navigation.LockedException
      Sets known accelerometer bias.
      Specified by:
      setBias in interface KnownBiasAccelerometerCalibrator
      Parameters:
      bias - accelerometer bias to be set.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialSx

      public double getInitialSx()
      Gets initial x scaling factor.
      Specified by:
      getInitialSx in interface AccelerometerNonLinearCalibrator
      Returns:
      initial x scaling factor.
    • setInitialSx

      public void setInitialSx(double initialSx) throws com.irurueta.navigation.LockedException
      Sets initial x scaling factor.
      Specified by:
      setInitialSx in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialSx - initial x scaling factor.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialSy

      public double getInitialSy()
      Gets initial y scaling factor. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialSy in interface AccelerometerNonLinearCalibrator
      Returns:
      initial y scaling factor.
    • setInitialSy

      public void setInitialSy(double initialSy) throws com.irurueta.navigation.LockedException
      Sets initial y scaling factor. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialSy in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialSy - initial y scaling factor.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialSz

      public double getInitialSz()
      Gets initial z scaling factor. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialSz in interface AccelerometerNonLinearCalibrator
      Returns:
      initial z scaling factor.
    • setInitialSz

      public void setInitialSz(double initialSz) throws com.irurueta.navigation.LockedException
      Sets initial z scaling factor. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialSz in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialSz - initial z scaling factor.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialMxy

      public double getInitialMxy()
      Gets initial x-y cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialMxy in interface AccelerometerNonLinearCalibrator
      Returns:
      initial x-y cross coupling error.
    • setInitialMxy

      public void setInitialMxy(double initialMxy) throws com.irurueta.navigation.LockedException
      Sets initial x-y cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialMxy in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialMxy - initial x-y cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialMxz

      public double getInitialMxz()
      Gets initial x-z cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialMxz in interface AccelerometerNonLinearCalibrator
      Returns:
      initial x-z cross coupling error.
    • setInitialMxz

      public void setInitialMxz(double initialMxz) throws com.irurueta.navigation.LockedException
      Sets initial x-z cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialMxz in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialMxz - initial x-z cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialMyx

      public double getInitialMyx()
      Gets initial y-x cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialMyx in interface AccelerometerNonLinearCalibrator
      Returns:
      initial y-x cross coupling error.
    • setInitialMyx

      public void setInitialMyx(double initialMyx) throws com.irurueta.navigation.LockedException
      Sets initial y-x cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialMyx in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialMyx - initial y-x cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialMyz

      public double getInitialMyz()
      Gets initial y-z cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialMyz in interface AccelerometerNonLinearCalibrator
      Returns:
      initial y-z cross coupling error.
    • setInitialMyz

      public void setInitialMyz(double initialMyz) throws com.irurueta.navigation.LockedException
      Sets initial y-z cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialMyz in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialMyz - initial y-z cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialMzx

      public double getInitialMzx()
      Gets initial z-x cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialMzx in interface AccelerometerNonLinearCalibrator
      Returns:
      initial z-x cross coupling error.
    • setInitialMzx

      public void setInitialMzx(double initialMzx) throws com.irurueta.navigation.LockedException
      Sets initial z-x cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialMzx in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialMzx - initial z-x cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInitialMzy

      public double getInitialMzy()
      Gets initial z-y cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialMzy in interface AccelerometerNonLinearCalibrator
      Returns:
      initial z-y cross coupling error.
    • setInitialMzy

      public void setInitialMzy(double initialMzy) throws com.irurueta.navigation.LockedException
      Sets initial z-y cross coupling error. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialMzy in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialMzy - initial z-y cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • setInitialScalingFactors

      public void setInitialScalingFactors(double initialSx, double initialSy, double initialSz) throws com.irurueta.navigation.LockedException
      Sets initial scaling factors. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialScalingFactors in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • setInitialCrossCouplingErrors

      public void setInitialCrossCouplingErrors(double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) throws com.irurueta.navigation.LockedException
      Sets initial cross coupling errors. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialCrossCouplingErrors in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialMxy - initial x-y cross coupling error.
      initialMxz - initial x-z cross coupling error.
      initialMyx - initial y-x cross coupling error.
      initialMyz - initial y-z cross coupling error.
      initialMzx - initial z-x cross coupling error.
      initialMzy - initial z-y cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • setInitialScalingFactorsAndCrossCouplingErrors

      public void setInitialScalingFactorsAndCrossCouplingErrors(double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) throws com.irurueta.navigation.LockedException
      Sets initial scaling factors and cross coupling errors. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialScalingFactorsAndCrossCouplingErrors in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      initialMxy - initial x-y cross coupling error.
      initialMxz - initial x-z cross coupling error.
      initialMyx - initial y-x cross coupling error.
      initialMyz - initial y-z cross coupling error.
      initialMzx - initial z-x cross coupling error.
      initialMzy - initial z-y cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getBias

      public double[] getBias()
      Gets known bias as an array. Array values are expressed in meters per squared second (m/s^2).
      Specified by:
      getBias in interface KnownBiasAccelerometerCalibrator
      Returns:
      array containing coordinates of known bias.
    • getBias

      public void getBias(double[] result)
      Gets known bias as an array. Array values are expressed in meters per squared second (m/s^2).
      Specified by:
      getBias in interface KnownBiasAccelerometerCalibrator
      Parameters:
      result - instance where result data will be copied to.
      Throws:
      IllegalArgumentException - if provided array does not have length 3.
    • setBias

      public void setBias(double[] bias) throws com.irurueta.navigation.LockedException
      Sets known bias as an array. Array values are expressed in meters per squared second (m/s^2).
      Specified by:
      setBias in interface KnownBiasAccelerometerCalibrator
      Parameters:
      bias - known bias to be set
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
      IllegalArgumentException - if provided array does not have length 3.
    • getBiasAsMatrix

      public com.irurueta.algebra.Matrix getBiasAsMatrix()
      Gets known bias as a column matrix.
      Specified by:
      getBiasAsMatrix in interface KnownBiasAccelerometerCalibrator
      Returns:
      known bias as a column matrix.
    • getBiasAsMatrix

      public void getBiasAsMatrix(com.irurueta.algebra.Matrix result)
      Gets known bias as a column matrix.
      Specified by:
      getBiasAsMatrix in interface KnownBiasAccelerometerCalibrator
      Parameters:
      result - instance where result data will be copied to.
      Throws:
      IllegalArgumentException - if provided matrix is not 3x1.
    • setBias

      public void setBias(com.irurueta.algebra.Matrix bias) throws com.irurueta.navigation.LockedException
      Sets known bias as an array.
      Specified by:
      setBias in interface KnownBiasAccelerometerCalibrator
      Parameters:
      bias - bias to be set.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
      IllegalArgumentException - if provided matrix is not 3x1.
    • getInitialMa

      public com.irurueta.algebra.Matrix getInitialMa()
      Gets initial scale factors and cross coupling errors matrix. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialMa in interface AccelerometerNonLinearCalibrator
      Returns:
      initial scale factors and cross coupling errors matrix.
    • getInitialMa

      public void getInitialMa(com.irurueta.algebra.Matrix result)
      Gets initial scale factors and cross coupling errors matrix. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      getInitialMa in interface AccelerometerNonLinearCalibrator
      Parameters:
      result - instance where data will be stored.
      Throws:
      IllegalArgumentException - if provided matrix is not 3x3.
    • setInitialMa

      public void setInitialMa(com.irurueta.algebra.Matrix initialMa) throws com.irurueta.navigation.LockedException
      Sets initial scale factors and cross coupling errors matrix. This is only taken into account if non-linear preliminary solutions are used.
      Specified by:
      setInitialMa in interface AccelerometerNonLinearCalibrator
      Parameters:
      initialMa - initial scale factors and cross coupling errors matrix.
      Throws:
      IllegalArgumentException - if provided matrix is not 3x3.
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getEcefPosition

      public com.irurueta.navigation.frames.ECEFPosition getEcefPosition()
      Gets position where body kinematics measures have been taken expressed in ECEF coordinates.
      Returns:
      position where body kinematics measures have been taken.
    • setPosition

      public void setPosition(com.irurueta.navigation.frames.ECEFPosition position) throws com.irurueta.navigation.LockedException
      Gets position where body kinematics measures have been taken expressed in ECEF coordinates.
      Parameters:
      position - position where body kinematics measures have been taken.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getNedPosition

      public com.irurueta.navigation.frames.NEDPosition getNedPosition()
      Gets position where body kinematics measures have been taken expressed in NED coordinates.
      Returns:
      position where body kinematics measures have been taken or null if not available.
    • getNedPosition

      public boolean getNedPosition(com.irurueta.navigation.frames.NEDPosition result)
      Gets position where body kinematics measures have been taken expressed in NED coordinates.
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if NED position could be computed, false otherwise.
    • setPosition

      public void setPosition(com.irurueta.navigation.frames.NEDPosition position) throws com.irurueta.navigation.LockedException
      Sets position where body kinematics measures have been taken expressed in NED coordinates.
      Parameters:
      position - position where body kinematics measures have been taken.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getMeasurements

      public List<StandardDeviationBodyKinematics> getMeasurements()
      Gets a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      Specified by:
      getMeasurements in interface OrderedStandardDeviationBodyKinematicsAccelerometerCalibrator
      Returns:
      list of body kinematics measurements.
    • setMeasurements

      public void setMeasurements(List<StandardDeviationBodyKinematics> measurements) throws com.irurueta.navigation.LockedException
      Sets a list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      Specified by:
      setMeasurements in interface OrderedStandardDeviationBodyKinematicsAccelerometerCalibrator
      Parameters:
      measurements - list of body kinematics measurements.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getMeasurementType

      public AccelerometerCalibratorMeasurementType getMeasurementType()
      Indicates the type of measurement used by this calibrator.
      Specified by:
      getMeasurementType in interface AccelerometerCalibrator
      Returns:
      type of measurement used by this calibrator.
    • isOrderedMeasurementsRequired

      public boolean isOrderedMeasurementsRequired()
      Indicates whether this calibrator requires ordered measurements in a list or not.
      Specified by:
      isOrderedMeasurementsRequired in interface AccelerometerCalibrator
      Returns:
      true if measurements must be ordered, false otherwise.
    • isCommonAxisUsed

      public boolean isCommonAxisUsed()
      Indicates whether z-axis is assumed to be common for accelerometer and gyroscope. When enabled, this eliminates 3 variables from Ma matrix.
      Specified by:
      isCommonAxisUsed in interface AccelerometerCalibrator
      Returns:
      true if z-axis is assumed to be common for accelerometer and gyroscope, false otherwise.
    • setCommonAxisUsed

      public void setCommonAxisUsed(boolean commonAxisUsed) throws com.irurueta.navigation.LockedException
      Specifies whether z-axis is assumed to be common for accelerometer and gyroscope. When enabled, this eliminates 3 variables from Ma matrix.
      Specified by:
      setCommonAxisUsed in interface AccelerometerCalibrator
      Parameters:
      commonAxisUsed - true if z-axis is assumed to be common for accelerometer and gyroscope, false otherwise.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getListener

      Gets listener to handle events raised by this estimator.
      Returns:
      listener to handle events raised by this estimator.
    • setListener

      public void setListener(RobustKnownBiasAndPositionAccelerometerCalibratorListener listener) throws com.irurueta.navigation.LockedException
      Sets listener to handle events raised by this estimator.
      Parameters:
      listener - listener to handle events raised by this estimator.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getMinimumRequiredMeasurements

      public int getMinimumRequiredMeasurements()
      Gets minimum number of required measurements.
      Specified by:
      getMinimumRequiredMeasurements in interface AccelerometerCalibrator
      Returns:
      minimum number of required measurements.
    • isReady

      public boolean isReady()
      Indicates whether calibrator is ready to start.
      Specified by:
      isReady in interface AccelerometerCalibrator
      Returns:
      true if calibrator is ready, false otherwise.
    • isRunning

      public boolean isRunning()
      Indicates whether calibrator is currently running or not.
      Specified by:
      isRunning in interface AccelerometerCalibrator
      Returns:
      true if calibrator is running, false otherwise.
    • getProgressDelta

      public float getProgressDelta()
      Returns amount of progress variation before notifying a progress change during calibration.
      Returns:
      amount of progress variation before notifying a progress change during calibration.
    • setProgressDelta

      public void setProgressDelta(float progressDelta) throws com.irurueta.navigation.LockedException
      Sets amount of progress variation before notifying a progress change during calibration.
      Parameters:
      progressDelta - amount of progress variation before notifying a progress change during calibration.
      Throws:
      IllegalArgumentException - if progress delta is less than zero or greater than 1.
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getConfidence

      public double getConfidence()
      Returns amount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%). The amount of confidence indicates the probability that the estimated result is correct. Usually this value will be close to 1.0, but not exactly 1.0.
      Returns:
      amount of confidence as a value between 0.0 and 1.0.
    • setConfidence

      public void setConfidence(double confidence) throws com.irurueta.navigation.LockedException
      Sets amount of confidence expressed as a value between 0.0 and 1.0 (which is equivalent to 100%). The amount of confidence indicates the probability that the estimated result is correct. Usually this value will be close to 1.0, but not exactly 1.0.
      Parameters:
      confidence - confidence to be set as a value between 0.0 and 1.0.
      Throws:
      IllegalArgumentException - if provided value is not between 0.0 and 1.0.
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getMaxIterations

      public int getMaxIterations()
      Returns maximum allowed number of iterations. If maximum allowed number of iterations is achieved without converging to a result when calling calibrate(), a RobustEstimatorException will be raised.
      Returns:
      maximum allowed number of iterations.
    • setMaxIterations

      public void setMaxIterations(int maxIterations) throws com.irurueta.navigation.LockedException
      Sets maximum allowed number of iterations. When the maximum number of iterations is exceeded, result will not be available, however an approximate result will be available for retrieval.
      Parameters:
      maxIterations - maximum allowed number of iterations to be set.
      Throws:
      IllegalArgumentException - if provided value is less than 1.
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getInliersData

      public com.irurueta.numerical.robust.InliersData getInliersData()
      Gets data related to inliers found after estimation.
      Returns:
      data related to inliers found after estimation.
    • isResultRefined

      public boolean isResultRefined()
      Indicates whether result must be refined using a non-linear solver over found inliers.
      Returns:
      true to refine result, false to simply use result found by robust estimator without further refining.
    • setResultRefined

      public void setResultRefined(boolean refineResult) throws com.irurueta.navigation.LockedException
      Specifies whether result must be refined using a non-linear solver over found inliers.
      Parameters:
      refineResult - true to refine result, false to simply use result found by robust estimator without further refining.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • isCovarianceKept

      public boolean isCovarianceKept()
      Indicates whether covariance must be kept after refining result. This setting is only taken into account if result is refined.
      Returns:
      true if covariance must be kept after refining result, false otherwise.
    • setCovarianceKept

      public void setCovarianceKept(boolean keepCovariance) throws com.irurueta.navigation.LockedException
      Specifies whether covariance must be kept after refining result. This setting is only taken into account if result is refined.
      Parameters:
      keepCovariance - true if covariance must be kept after refining result, false otherwise.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getQualityScores

      public double[] getQualityScores()
      Returns quality scores corresponding to each measurement. The larger the score value the better the quality of the sample. This implementation always returns null. Subclasses using quality scores must implement proper behavior.
      Specified by:
      getQualityScores in interface QualityScoredAccelerometerCalibrator
      Returns:
      quality scores corresponding to each sample.
    • setQualityScores

      public void setQualityScores(double[] qualityScores) throws com.irurueta.navigation.LockedException
      Sets quality scores corresponding to each measurement. The larger the score value the better the quality of the sample. This implementation makes no action. Subclasses using quality scores must implement proper behaviour.
      Specified by:
      setQualityScores in interface QualityScoredAccelerometerCalibrator
      Parameters:
      qualityScores - quality scores corresponding to each pair of matched points.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than minimum required samples.
      com.irurueta.navigation.LockedException - if calibrator is currently running.
    • getEstimatedMa

      public com.irurueta.algebra.Matrix getEstimatedMa()
      Gets estimated accelerometer scale factors and ross coupling errors. This is the product of matrix Ta containing cross coupling errors and Ka containing scaling factors. So tat:
           Ma = [sx    mxy  mxz] = Ta*Ka
                [myx   sy   myz]
                [mzx   mzy  sz ]
       
      Where:
           Ka = [sx 0   0 ]
                [0  sy  0 ]
                [0  0   sz]
       
      and
           Ta = [1          -alphaXy    alphaXz ]
                [alphaYx    1           -alphaYz]
                [-alphaZx   alphaZy     1       ]
       
      Hence:
           Ma = [sx    mxy  mxz] = Ta*Ka =  [sx             -sy * alphaXy   sz * alphaXz ]
                [myx   sy   myz]            [sx * alphaYx   sy              -sz * alphaYz]
                [mzx   mzy  sz ]            [-sx * alphaZx  sy * alphaZy    sz           ]
       
      This instance allows any 3x3 matrix however, typically alphaYx, alphaZx and alphaZy are considered to be zero if the accelerometer z-axis is assumed to be the same as the body z-axis. When this is assumed, myx = mzx = mzy = 0 and the Ma matrix becomes upper diagonal:
           Ma = [sx    mxy  mxz]
                [0     sy   myz]
                [0     0    sz ]
       
      Values of this matrix are unit-less.
      Specified by:
      getEstimatedMa in interface AccelerometerCalibrator
      Returns:
      estimated accelerometer scale factors and cross coupling errors, or null if not available.
    • getEstimatedSx

      public Double getEstimatedSx()
      Gets estimated x-axis scale factor.
      Specified by:
      getEstimatedSx in interface AccelerometerCalibrator
      Returns:
      estimated x-axis scale factor or null if not available.
    • getEstimatedSy

      public Double getEstimatedSy()
      Gets estimated y-axis scale factor.
      Specified by:
      getEstimatedSy in interface AccelerometerCalibrator
      Returns:
      estimated y-axis scale factor or null if not available.
    • getEstimatedSz

      public Double getEstimatedSz()
      Gets estimated z-axis scale factor.
      Specified by:
      getEstimatedSz in interface AccelerometerCalibrator
      Returns:
      estimated z-axis scale factor or null if not available.
    • getEstimatedMxy

      public Double getEstimatedMxy()
      Gets estimated x-y cross-coupling error.
      Specified by:
      getEstimatedMxy in interface AccelerometerCalibrator
      Returns:
      estimated x-y cross-coupling error or null if not available.
    • getEstimatedMxz

      public Double getEstimatedMxz()
      Gets estimated x-z cross-coupling error.
      Specified by:
      getEstimatedMxz in interface AccelerometerCalibrator
      Returns:
      estimated x-z cross-coupling error or null if not available.
    • getEstimatedMyx

      public Double getEstimatedMyx()
      Gets estimated y-x cross-coupling error.
      Specified by:
      getEstimatedMyx in interface AccelerometerCalibrator
      Returns:
      estimated y-x cross-coupling error or null if not available.
    • getEstimatedMyz

      public Double getEstimatedMyz()
      Gets estimated y-z cross-coupling error.
      Specified by:
      getEstimatedMyz in interface AccelerometerCalibrator
      Returns:
      estimated y-z cross-coupling error or null if not available.
    • getEstimatedMzx

      public Double getEstimatedMzx()
      Gets estimated z-x cross-coupling error.
      Specified by:
      getEstimatedMzx in interface AccelerometerCalibrator
      Returns:
      estimated z-x cross-coupling error or null if not available.
    • getEstimatedMzy

      public Double getEstimatedMzy()
      Gets estimated z-y cross-coupling error.
      Specified by:
      getEstimatedMzy in interface AccelerometerCalibrator
      Returns:
      estimated z-y cross-coupling error or null if not available.
    • getEstimatedCovariance

      public com.irurueta.algebra.Matrix getEstimatedCovariance()
      Gets estimated covariance matrix for estimated calibration solution. Diagonal elements of the matrix contains variance for the following parameters (following indicated order): sx, sy, sz, mxy, mxz, myx, myz, mzx, mzy. This is only available when result has been refined and covariance is kept.
      Specified by:
      getEstimatedCovariance in interface AccelerometerNonLinearCalibrator
      Returns:
      estimated covariance matrix for estimated position.
    • getEstimatedChiSq

      public double getEstimatedChiSq()
      Gets estimated chi square value.
      Specified by:
      getEstimatedChiSq in interface AccelerometerNonLinearCalibrator
      Returns:
      estimated chi square value.
    • getEstimatedMse

      public double getEstimatedMse()
      Gets estimated mean square error respect to provided measurements.
      Specified by:
      getEstimatedMse in interface AccelerometerNonLinearCalibrator
      Returns:
      estimated mean square error respect to provided measurements.
    • getPreliminarySubsetSize

      public int getPreliminarySubsetSize()
      Gets size of subsets to be checked during robust estimation. This has to be at least getMinimumRequiredMeasurements().
      Returns:
      size of subsets to be checked during robust estimation.
    • setPreliminarySubsetSize

      public void setPreliminarySubsetSize(int preliminarySubsetSize) throws com.irurueta.navigation.LockedException
      Sets size of subsets to be checked during robust estimation. This has to be at least getMinimumRequiredMeasurements().
      Parameters:
      preliminarySubsetSize - size of subsets to be checked during robust estimation.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
      IllegalArgumentException - if provided value is less than getMinimumRequiredMeasurements().
    • getMethod

      public abstract com.irurueta.numerical.robust.RobustEstimatorMethod getMethod()
      Returns method being used for robust estimation.
      Returns:
      method being used for robust estimation.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope. If true 7 samples are required, otherwise 10.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope. If true 7 samples are required, otherwise 10.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3 or quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1 or if quality scores array is smaller than 13 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope. If true 7 samples are required, otherwise 10.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope. If true 7 samples are required, otherwise 10.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3 or quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if quality scores array is smaller than 10 samples.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] qualityScores, com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener, com.irurueta.numerical.robust.RobustEstimatorMethod method)
      Creates a robust accelerometer calibrator.
      Parameters:
      qualityScores - quality scores corresponding to each provided measurement. The larger the score value the better the quality of the sample.
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      method - robust estimator method.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3 or if provided quality scores length is smaller than the minimum number of required samples (7 or 10).
    • create

      Creates a robust accelerometer calibrator using default robust method.
      Returns:
      a robust accelerometer calibrator.
    • create

      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      Returns:
      a robust accelerometer calibrator.
    • create

      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(boolean commonAxisUsed)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(double[] bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.algebra.Matrix bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      bias - known accelerometer bias.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.ECEFPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - list of body kinematics measurements taken at a given position with different unknown orientations and containing the standard deviations of accelerometer and gyroscope measurements.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      listener - listener to be notified of events such as when estimation starts, ends or its progress significantly changes.
      Returns:
      a robust accelerometer calibrator.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, double[] bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias. This must have length 3 and is expressed in meters per squared second (m/s^2).
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • create

      public static RobustKnownBiasAndPositionAccelerometerCalibrator create(com.irurueta.navigation.frames.NEDPosition position, List<StandardDeviationBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix bias, com.irurueta.algebra.Matrix initialMa, RobustKnownBiasAndPositionAccelerometerCalibratorListener listener)
      Creates a robust accelerometer calibrator using default robust method.
      Parameters:
      position - position where body kinematics measures have been taken.
      measurements - collection of body kinematics measurements with standard deviations taken at the same position with zero velocity and unknown different orientations.
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      bias - known accelerometer bias.
      initialMa - initial scale factors and cross coupling errors matrix.
      listener - listener to handle events raised by this calibrator.
      Returns:
      a robust accelerometer calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1 or scaling and coupling error matrix is not 3x3.
    • computeError

      protected double computeError(StandardDeviationBodyKinematics measurement, RobustKnownBiasAndPositionAccelerometerCalibrator.PreliminaryResult preliminaryResult)
      Computes error of preliminary result respect a given measurement for current gravity norm.
      Parameters:
      measurement - a measurement.
      preliminaryResult - a preliminary result.
      Returns:
      computed error.
    • computePreliminarySolutions

      protected void computePreliminarySolutions(int[] samplesIndices, List<RobustKnownBiasAndPositionAccelerometerCalibrator.PreliminaryResult> solutions)
      Computes a preliminary solution for a subset of samples picked by a robust estimator.
      Parameters:
      samplesIndices - indices of samples picked by the robust estimator.
      solutions - list where estimated preliminary solution will be stored.
    • attemptRefine

      protected void attemptRefine(RobustKnownBiasAndPositionAccelerometerCalibrator.PreliminaryResult preliminaryResult)
      Attempts to refine calibration parameters if refinement is requested. This method returns a refined solution or provided input if refinement is not requested or has failed. If refinement is enabled and it is requested to keep covariance, this method will also keep covariance of refined position.
      Parameters:
      preliminaryResult - a preliminary result.
    • computeGravityNorm

      protected double computeGravityNorm()
      Computes gravity norm for current position.
      Returns:
      gravity norm for current position expressed in meters per squared second.
    • convertPosition

      private static com.irurueta.navigation.frames.ECEFPosition convertPosition(com.irurueta.navigation.frames.NEDPosition position)
      Converts provided NED position expressed in terms of latitude, longitude and height respect mean Earth surface, to position expressed in ECEF coordinates.
      Parameters:
      position - NED position to be converted.
      Returns:
      converted position expressed in ECEF coordinates.
    • convertAcceleration

      private static double convertAcceleration(double value, com.irurueta.units.AccelerationUnit unit)
      Converts acceleration value and unit to meters per squared second.
      Parameters:
      value - acceleration value.
      unit - unit of acceleration value.
      Returns:
      converted value.
    • convertAcceleration

      private static double convertAcceleration(com.irurueta.units.Acceleration acceleration)
      Converts acceleration instance to meters per squared second.
      Parameters:
      acceleration - acceleration instance to be converted.
      Returns:
      converted value.