Package com.irurueta.navigation.inertial.calibration.gyroscope

Class KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

java.lang.Object
com.irurueta.navigation.inertial.calibration.gyroscope.KnownFrameGyroscopeNonLinearLeastSquaresCalibrator
All Implemented Interfaces:
GyroscopeCalibrator, GyroscopeNonLinearCalibrator, KnownFrameGyroscopeCalibrator<StandardDeviationFrameBodyKinematics,KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener>, UnknownBiasGyroscopeCalibrator, UnknownBiasNonLinearGyroscopeCalibrator, UnorderedStandardDeviationFrameBodyKinematicsGyroscopeCalibrator, GyroscopeBiasUncertaintySource, GyroscopeCalibrationSource
public class KnownFrameGyroscopeNonLinearLeastSquaresCalibrator extends Object implements KnownFrameGyroscopeCalibrator<StandardDeviationFrameBodyKinematics,KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener>, GyroscopeNonLinearCalibrator, UnknownBiasNonLinearGyroscopeCalibrator, GyroscopeCalibrationSource, GyroscopeBiasUncertaintySource, UnorderedStandardDeviationFrameBodyKinematicsGyroscopeCalibrator
Estimates gyroscope biases, cross couplings and scaling factors along with G-dependent cross biases introduced on the gyroscope by the specific forces sensed by the accelerometer.

This calibrator uses an iterative approach to find a minimum least squared error solution.

To use this calibrator at least 7 measurements at different known frames must be provided. In other words, accelerometer and gyroscope (i.e. body kinematics) samples must be obtained at 7 different positions, orientations and velocities (although typically velocities are always zero).

Measured gyroscope angular rates is assumed to follow the model shown below: 

     Ωmeas = bg + (I + Mg) * Ωtrue + Gg * ftrue + w
Where: - Ωmeas is the measured gyroscope angular rates. This is a 3x1 vector. - bg is the gyroscope bias. Ideally, on a perfect gyroscope, this should be a 3x1 zero vector. - I is the 3x3 identity matrix. - Mg is the 3x3 matrix containing cross-couplings and scaling factors. Ideally, on a perfect gyroscope, this should be a 3x3 zero matrix. - Ωtrue is ground-truth gyroscope angular rates. - Gg is the G-dependent cross biases introduced by the specific forces sensed by the accelerometer. Ideally, on a perfect gyroscope, this should be a 3x3 zero matrix. - ftrue is ground-truth specific force. This is a 3x1 vector. - w is measurement noise. This is a 3x1 vector.

  • 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

      public static final int MINIMUM_MEASUREMENTS
      Required minimum number of measurements.
      See Also:

    • COMMON_Z_AXIS_UNKNOWNS

      private static final int COMMON_Z_AXIS_UNKNOWNS
      Number of unknowns when common z-axis is assumed for both the accelerometer and gyroscope.
      See Also:

    • GENERAL_UNKNOWNS

      private static final int GENERAL_UNKNOWNS
      Number of unknowns for the general case.
      See Also:

    • fitter

      private final com.irurueta.numerical.fitting.LevenbergMarquardtMultiVariateFitter fitter
      Levenberg-Marquardt fitter to find a non-linear solution.

    • initialBiasX

      private double initialBiasX
      Initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).

    • initialBiasY

      private double initialBiasY
      Initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).

    • initialBiasZ

      private double initialBiasZ
      Initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).

    • 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.

    • initialGg

      private com.irurueta.algebra.Matrix initialGg
      Initial G-dependent cross biases introduced on the gyroscope by the specific forces sensed by the accelerometer.

    • measurements

      private Collection<StandardDeviationFrameBodyKinematics> measurements
      Contains a collections of body kinematics measurements taken at different frames (positions, orientations and velocities) and containing the standard deviations of accelerometer and gyroscope measurements. If a single device IMU needs to be calibrated, typically all measurements are taken at the same position, with zero velocity and multiple orientations. However, if we just want to calibrate a given IMU model (e.g. obtain an average and less precise calibration for the IMU of a given phone model), we could take measurements collected throughout the planet at multiple positions while the phone remains static (e.g. while charging), hence each measurement position will change, velocity will remain zero and orientation will be typically constant at horizontal orientation while the phone remains on a flat surface.

    • 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.

    • listener

      private KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener
      Listener to handle events raised by this calibrator.

    • estimatedBiases

      private double[] estimatedBiases
      Estimated angular rate biases for each IMU axis expressed in radians per second (rad/s).

    • estimatedMg

      private com.irurueta.algebra.Matrix estimatedMg
      Estimated gyroscope scale factors and cross coupling errors. This is the product of matrix Tg containing cross coupling errors and Kg containing scaling factors. So that: 
           Mg = [sx    mxy  mxz] = Tg*Kg
          [myx   sy   myz]
          [mzx   mzy  sz ]
      Where: 
           Kg = [sx 0   0 ]
          [0  sy  0 ]
          [0  0   sz]
      and 
           Tg = [1          -alphaXy    alphaXz ]
          [alphaYx    1           -alphaYz]
          [-alphaZx   alphaZy     1       ]
      Hence: 
           Mg = [sx    mxy  mxz] = Tg*Kg =  [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 gyroscope z-axis is assumed to be the same as the body z-axis. When this is assumed, myx = mzx = mzy = 0 and the Mg matrix becomes upper diagonal: 
           Mg = [sx    mxy  mxz]
          [0     sy   myz]
          [0     0    sz ]
      Values of this matrix are unit-less.

    • estimatedGg

      private com.irurueta.algebra.Matrix estimatedGg
      Estimated G-dependent cross biases introduced on the gyroscope by the specific forces sensed by the accelerometer. This instance allows any 3x3 matrix.

    • estimatedCovariance

      private com.irurueta.algebra.Matrix estimatedCovariance
      Estimated covariance matrix for estimated parameters.

    • estimatedChiSq

      private double estimatedChiSq
      Estimated chi square value.

    • estimatedChiSqDegreesOfFreedom

      private int estimatedChiSqDegreesOfFreedom
      Estimated degrees of freedom of chi square value. Degrees of freedom is equal to the number of sampled data minus the number of estimated parameters.

    • estimatedReducedChiSq

      private double estimatedReducedChiSq
      Estimated reduced chi square value. This is equal to estimated chi square value divided by its degrees of freedom. Ideally this value should be close to 1.0.

    • estimatedMse

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

    • estimatedP

      private double estimatedP
      Estimated probability of finding a smaller chi square value expressed as a value between 0.0 and 1.0. The smaller the found chi square value is, the better the fit of the estimated parameters to the actual parameter. Thus, the smaller the chance of finding a smaller chi square value, then the better the estimated fit is.

    • estimatedQ

      private double estimatedQ
      Estimated measure of quality of estimated fit as a value between 0.0 and 1.0. The larger the quality value is, the better the fit that has been estimated.

    • running

      private boolean running
      Indicates whether calibrator is running.

  • Constructor Details

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator()
      Constructor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

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

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(double initialBiasX, double initialBiasY, double initialBiasZ)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(double initialBiasX, double initialBiasY, double initialBiasZ, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, double initialBiasX, double initialBiasY, double initialBiasZ)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, double initialBiasX, double initialBiasY, double initialBiasZ, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      listener - listeners to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      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.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      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.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, double initialBiasX, double initialBiasY, double initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      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.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      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.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      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.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      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.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ, double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBiasX - initial x-coordinate of gyroscope bias to be used to find a solution.
      initialBiasY - initial y-coordinate of gyroscope bias to be used to find a solution.
      initialBiasZ - initial z-coordinate of gyroscope bias to be used to find a solution.
      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.
      listener - listener to handle events raised by this calibrator.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(double[] initialBias)
      Constructor.
      Parameters:
      initialBias - initial gyroscope bias to be used to find a solution. This must have length 3 and is expressed in radians per second (rad/s).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(double[] initialBias, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      initialBias - initial gyroscope bias to be used to find a solution. This must have length 3 and is expressed in radians per second (rad/s).
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, double[] initialBias)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBias - initial gyroscope bias to be used to find a solution. This must have length 3 and is expressed in radians per second (rad/s).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, double[] initialBias, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBias - initial gyroscope bias to be used to find a solution. This must have length 3 and is expressed in radians per second (rad/s).
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double[] initialBias)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial gyroscope bias to be used to find a solution. This must have length 3 and is expressed in radians per second (rad/s).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, double[] initialBias, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial gyroscope bias to be used to find a solution. This must have length 3 and is expressed in radians per second (rad/s).
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, double[] initialBias)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial gyroscope bias to be used to find a solution. This must have length 3 and is expressed in radians per second (rad/s).
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, double[] initialBias, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial gyroscope bias to be used to find a solution. This must have length 3 and is expressed in radians per second (rad/s).
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias array does not have length 3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix initialBias)
      Constructor.
      Parameters:
      initialBias - initial bias to find a solution.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix initialBias, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      initialBias - initial bias to find a solution.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.algebra.Matrix initialBias)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBias - initial bias to find a solution.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.algebra.Matrix initialBias, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBias - initial bias to find a solution.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if provided bias matrix is not 3x1.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg)
      Constructor.
      Parameters:
      initialBias - initial bias to find a solution.
      initialMg - 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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      initialBias - initial bias to find a solution.
      initialMg - 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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBias - initial bias to find a solution.
      initialMg - 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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBias - initial bias to find a solution.
      initialMg - 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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      initialMg - 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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      initialMg - 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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      initialMg - 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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      initialMg - 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.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, com.irurueta.algebra.Matrix initialGg)
      Constructor.
      Parameters:
      initialBias - initial bias to find a solution.
      initialMg - initial scale factors and cross coupling errors matrix.
      initialGg - initial G-dependent cross biases.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1, scaling and coupling error matrix is not 3x3 or g-dependant cross biases is not 3x3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, com.irurueta.algebra.Matrix initialGg, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      initialBias - initial bias to find a solution.
      initialMg - initial scale factors and cross coupling errors matrix.
      initialGg - initial G-dependent cross biases.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1, scaling and coupling error matrix is not 3x3 or g-dependant cross biases is not 3x3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, com.irurueta.algebra.Matrix initialGg)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBias - initial bias to find a solution.
      initialMg - initial scale factors and cross coupling errors matrix.
      initialGg - initial G-dependent cross biases.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1, scaling and coupling error matrix is not 3x3 or g-dependant cross biases is not 3x3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, com.irurueta.algebra.Matrix initialGg, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      initialBias - initial bias to find a solution.
      initialMg - initial scale factors and cross coupling errors matrix.
      initialGg - initial G-dependent cross biases.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1, scaling and coupling error matrix is not 3x3 or g-dependant cross biases is not 3x3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, com.irurueta.algebra.Matrix initialGg)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      initialMg - initial scale factors and cross coupling errors matrix.
      initialGg - initial G-dependent cross biases.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1, scaling and coupling error matrix is not 3x3 or g-dependant cross biases is not 3x3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, com.irurueta.algebra.Matrix initialGg, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      initialMg - initial scale factors and cross coupling errors matrix.
      initialGg - initial G-dependent cross biases.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1, scaling and coupling error matrix is not 3x3 or g-dependant cross biases is not 3x3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, com.irurueta.algebra.Matrix initialGg)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      initialMg - initial scale factors and cross coupling errors matrix.
      initialGg - initial G-dependent cross biases.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1, scaling and coupling error matrix is not 3x3 or g-dependant cross biases is not 3x3.

    • KnownFrameGyroscopeNonLinearLeastSquaresCalibrator

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibrator(Collection<StandardDeviationFrameBodyKinematics> measurements, boolean commonAxisUsed, com.irurueta.algebra.Matrix initialBias, com.irurueta.algebra.Matrix initialMg, com.irurueta.algebra.Matrix initialGg, KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener)
      Constructor.
      Parameters:
      measurements - collection of body kinematics measurements with standard deviations taken at different frames (positions, orientations and velocities).
      commonAxisUsed - indicates whether z-axis is assumed to be common for accelerometer and gyroscope.
      initialBias - initial bias to find a solution.
      initialMg - initial scale factors and cross coupling errors matrix.
      initialGg - initial G-dependent cross biases.
      listener - listener to handle events raised by this calibrator.
      Throws:
      IllegalArgumentException - if either provided bias matrix is not 3x1, scaling and coupling error matrix is not 3x3 or g-dependant cross biases is not 3x3.

  • Method Details

    • getInitialBiasX

      public double getInitialBiasX()
      Gets initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      Specified by:
      getInitialBiasX in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      initial x-coordinate of gyroscope bias.

    • setInitialBiasX

      public void setInitialBiasX(double initialBiasX) throws com.irurueta.navigation.LockedException
      Sets initial x-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      Specified by:
      setInitialBiasX in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialBiasY

      public double getInitialBiasY()
      Gets initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      Specified by:
      getInitialBiasY in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      initial y-coordinate of gyroscope bias.

    • setInitialBiasY

      public void setInitialBiasY(double initialBiasY) throws com.irurueta.navigation.LockedException
      Sets initial y-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      Specified by:
      setInitialBiasY in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBiasY - initial y-coordinate of gyroscope bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialBiasZ

      public double getInitialBiasZ()
      Gets initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      Specified by:
      getInitialBiasZ in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      initial z-coordinate of gyroscope bias.

    • setInitialBiasZ

      public void setInitialBiasZ(double initialBiasZ) throws com.irurueta.navigation.LockedException
      Sets initial z-coordinate of gyroscope bias to be used to find a solution. This is expressed in radians per second (rad/s).
      Specified by:
      setInitialBiasZ in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBiasZ - initial z-coordinate of gyroscope bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialBiasAngularSpeedX

      public com.irurueta.units.AngularSpeed getInitialBiasAngularSpeedX()
      Gets initial x-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      getInitialBiasAngularSpeedX in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      initial x-coordinate of gyroscope bias.

    • getInitialBiasAngularSpeedX

      public void getInitialBiasAngularSpeedX(com.irurueta.units.AngularSpeed result)
      Gets initial x-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      getInitialBiasAngularSpeedX in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      result - instance where result data will be stored.

    • setInitialBiasX

      public void setInitialBiasX(com.irurueta.units.AngularSpeed initialBiasX) throws com.irurueta.navigation.LockedException
      Sets initial x-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      setInitialBiasX in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialBiasAngularSpeedY

      public com.irurueta.units.AngularSpeed getInitialBiasAngularSpeedY()
      Gets initial y-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      getInitialBiasAngularSpeedY in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      initial y-coordinate of gyroscope bias.

    • getInitialBiasAngularSpeedY

      public void getInitialBiasAngularSpeedY(com.irurueta.units.AngularSpeed result)
      Gets initial y-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      getInitialBiasAngularSpeedY in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      result - instance where result data will be stored.

    • setInitialBiasY

      public void setInitialBiasY(com.irurueta.units.AngularSpeed initialBiasY) throws com.irurueta.navigation.LockedException
      Sets initial y-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      setInitialBiasY in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBiasY - initial y-coordinate of gyroscope bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialBiasAngularSpeedZ

      public com.irurueta.units.AngularSpeed getInitialBiasAngularSpeedZ()
      Gets initial z-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      getInitialBiasAngularSpeedZ in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      initial z-coordinate of gyroscope bias.

    • getInitialBiasAngularSpeedZ

      public void getInitialBiasAngularSpeedZ(com.irurueta.units.AngularSpeed result)
      Gets initial z-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      getInitialBiasAngularSpeedZ in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      result - instance where result data will be stored.

    • setInitialBiasZ

      public void setInitialBiasZ(com.irurueta.units.AngularSpeed initialBiasZ) throws com.irurueta.navigation.LockedException
      Sets initial z-coordinate of gyroscope bias to be used to find a solution.
      Specified by:
      setInitialBiasZ in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBiasZ - initial z-coordinate of gyroscope bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • setInitialBias

      public void setInitialBias(double initialBiasX, double initialBiasY, double initialBiasZ) throws com.irurueta.navigation.LockedException
      Sets initial bias coordinates of gyroscope used to find a solution expressed in radians per second (rad/s).
      Specified by:
      setInitialBias in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias.
      initialBiasY - initial y-coordinate of gyroscope bias.
      initialBiasZ - initial z-coordinate of gyroscope bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • setInitialBias

      public void setInitialBias(com.irurueta.units.AngularSpeed initialBiasX, com.irurueta.units.AngularSpeed initialBiasY, com.irurueta.units.AngularSpeed initialBiasZ) throws com.irurueta.navigation.LockedException
      Sets initial bias coordinates of gyroscope used to find a solution.
      Specified by:
      setInitialBias in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBiasX - initial x-coordinate of gyroscope bias.
      initialBiasY - initial y-coordinate of gyroscope bias.
      initialBiasZ - initial z-coordinate of gyroscope bias.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialSx

      public double getInitialSx()
      Gets initial x scaling factor.
      Specified by:
      getInitialSx in interface GyroscopeNonLinearCalibrator
      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 GyroscopeNonLinearCalibrator
      Parameters:
      initialSx - initial x scaling factor.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialSy

      public double getInitialSy()
      Gets initial y scaling factor.
      Specified by:
      getInitialSy in interface GyroscopeNonLinearCalibrator
      Returns:
      initial y scaling factor.

    • setInitialSy

      public void setInitialSy(double initialSy) throws com.irurueta.navigation.LockedException
      Sets initial y scaling factor.
      Specified by:
      setInitialSy in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialSy - initial y scaling factor.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialSz

      public double getInitialSz()
      Gets initial z scaling factor.
      Specified by:
      getInitialSz in interface GyroscopeNonLinearCalibrator
      Returns:
      initial z scaling factor.

    • setInitialSz

      public void setInitialSz(double initialSz) throws com.irurueta.navigation.LockedException
      Sets initial z scaling factor.
      Specified by:
      setInitialSz in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialSz - initial z scaling factor.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialMxy

      public double getInitialMxy()
      Gets initial x-y cross coupling error.
      Specified by:
      getInitialMxy in interface GyroscopeNonLinearCalibrator
      Returns:
      initial x-y cross coupling error.

    • setInitialMxy

      public void setInitialMxy(double initialMxy) throws com.irurueta.navigation.LockedException
      Sets initial x-y cross coupling error.
      Specified by:
      setInitialMxy in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialMxy - initial x-y cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialMxz

      public double getInitialMxz()
      Gets initial x-z cross coupling error.
      Specified by:
      getInitialMxz in interface GyroscopeNonLinearCalibrator
      Returns:
      initial x-z cross coupling error.

    • setInitialMxz

      public void setInitialMxz(double initialMxz) throws com.irurueta.navigation.LockedException
      Sets initial x-z cross coupling error.
      Specified by:
      setInitialMxz in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialMxz - initial x-z cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialMyx

      public double getInitialMyx()
      Gets initial y-x cross coupling error.
      Specified by:
      getInitialMyx in interface GyroscopeNonLinearCalibrator
      Returns:
      initial y-x cross coupling error.

    • setInitialMyx

      public void setInitialMyx(double initialMyx) throws com.irurueta.navigation.LockedException
      Sets initial y-x cross coupling error.
      Specified by:
      setInitialMyx in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialMyx - initial y-x cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialMyz

      public double getInitialMyz()
      Gets initial y-z cross coupling error.
      Specified by:
      getInitialMyz in interface GyroscopeNonLinearCalibrator
      Returns:
      initial y-z cross coupling error.

    • setInitialMyz

      public void setInitialMyz(double initialMyz) throws com.irurueta.navigation.LockedException
      Sets initial y-z cross coupling error.
      Specified by:
      setInitialMyz in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialMyz - initial y-z cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialMzx

      public double getInitialMzx()
      Gets initial z-x cross coupling error.
      Specified by:
      getInitialMzx in interface GyroscopeNonLinearCalibrator
      Returns:
      initial z-x cross coupling error.

    • setInitialMzx

      public void setInitialMzx(double initialMzx) throws com.irurueta.navigation.LockedException
      Sets initial z-x cross coupling error.
      Specified by:
      setInitialMzx in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialMzx - initial z-x cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialMzy

      public double getInitialMzy()
      Gets initial z-y cross coupling error.
      Specified by:
      getInitialMzy in interface GyroscopeNonLinearCalibrator
      Returns:
      initial z-y cross coupling error.

    • setInitialMzy

      public void setInitialMzy(double initialMzy) throws com.irurueta.navigation.LockedException
      Sets initial z-y cross coupling error.
      Specified by:
      setInitialMzy in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialMzy - initial z-y cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • setInitialScalingFactors

      public void setInitialScalingFactors(double initialSx, double initialSy, double initialSz) throws com.irurueta.navigation.LockedException
      Sets initial scaling factors.
      Specified by:
      setInitialScalingFactors in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialSx - initial x scaling factor.
      initialSy - initial y scaling factor.
      initialSz - initial z scaling factor.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • setInitialCrossCouplingErrors

      public void setInitialCrossCouplingErrors(double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) throws com.irurueta.navigation.LockedException
      Sets initial cross coupling errors.
      Specified by:
      setInitialCrossCouplingErrors in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialMxy - initial x-y cross coupling error.
      initialMxz - initial x-z cross coupling error.
      initialMyx - initial y-x cross coupling error.
      initialMyz - initial y-z cross coupling error.
      initialMzx - initial z-x cross coupling error.
      initialMzy - initial z-y cross coupling error.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • setInitialScalingFactorsAndCrossCouplingErrors

      public void setInitialScalingFactorsAndCrossCouplingErrors(double initialSx, double initialSy, double initialSz, double initialMxy, double initialMxz, double initialMyx, double initialMyz, double initialMzx, double initialMzy) throws com.irurueta.navigation.LockedException
      Sets initial scaling factors and cross coupling errors.
      Specified by:
      setInitialScalingFactorsAndCrossCouplingErrors in interface GyroscopeNonLinearCalibrator
      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.

    • getInitialBias

      public double[] getInitialBias()
      Gets initial bias to be used to find a solution as an array. Array values are expressed in radians per second (rad/s).
      Specified by:
      getInitialBias in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      array containing coordinates of initial bias.

    • getInitialBias

      public void getInitialBias(double[] result)
      Gets initial bias to be used to find a solution as an array. Array values are expressed in radians per second (rad/s).
      Specified by:
      getInitialBias in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      result - instance where result data will be copied to.
      Throws:
      IllegalArgumentException - if provided array does not have length 3.

    • setInitialBias

      public void setInitialBias(double[] initialBias) throws com.irurueta.navigation.LockedException
      Sets initial bias to be used to find a solution as an array. Array values are expressed in radians per second (rad/s).
      Specified by:
      setInitialBias in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBias - initial bias to find a solution.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
      IllegalArgumentException - if provided array does not have length 3.

    • getInitialBiasAsMatrix

      public com.irurueta.algebra.Matrix getInitialBiasAsMatrix()
      Gets initial bias to be used to find a solution as a column matrix. Values are expressed in radians per second (rad/s).
      Specified by:
      getInitialBiasAsMatrix in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      initial bias to be used to find a solution as a column matrix.

    • getInitialBiasAsMatrix

      public void getInitialBiasAsMatrix(com.irurueta.algebra.Matrix result)
      Gets initial bias to be used to find a solution as a column matrix. Values are expressed in radians per second (rad/s).
      Specified by:
      getInitialBiasAsMatrix in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      result - instance where result data will be copied to.
      Throws:
      IllegalArgumentException - if provided matrix is not 3x1.

    • setInitialBias

      public void setInitialBias(com.irurueta.algebra.Matrix initialBias) throws com.irurueta.navigation.LockedException
      Sets initial bias to be used to find a solution as a column matrix with values expressed in radians per second (rad/s).
      Specified by:
      setInitialBias in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBias - initial bias to find a solution.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
      IllegalArgumentException - if provided matrix is not 3x1.

    • getInitialBiasAsTriad

      public AngularSpeedTriad getInitialBiasAsTriad()
      Gets initial bias coordinates of gyroscope used to find a solution.
      Specified by:
      getInitialBiasAsTriad in interface UnknownBiasNonLinearGyroscopeCalibrator
      Returns:
      initial bias coordinates.

    • getInitialBiasAsTriad

      public void getInitialBiasAsTriad(AngularSpeedTriad result)
      Gets initial bias coordinates of gyroscope used to find a solution.
      Specified by:
      getInitialBiasAsTriad in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      result - instance where result will be stored.

    • setInitialBias

      public void setInitialBias(AngularSpeedTriad initialBias) throws com.irurueta.navigation.LockedException
      Sets initial bias coordinates of gyroscope used to find a solution.
      Specified by:
      setInitialBias in interface UnknownBiasNonLinearGyroscopeCalibrator
      Parameters:
      initialBias - initial bias coordinates to be set.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getInitialMg

      public com.irurueta.algebra.Matrix getInitialMg()
      Gets initial scale factors and cross coupling errors matrix.
      Specified by:
      getInitialMg in interface GyroscopeNonLinearCalibrator
      Returns:
      initial scale factors and cross coupling errors matrix.

    • getInitialMg

      public void getInitialMg(com.irurueta.algebra.Matrix result)
      Gets initial scale factors and cross coupling errors matrix.
      Specified by:
      getInitialMg in interface GyroscopeNonLinearCalibrator
      Parameters:
      result - instance where data will be stored.
      Throws:
      IllegalArgumentException - if provided matrix is not 3x3.

    • setInitialMg

      public void setInitialMg(com.irurueta.algebra.Matrix initialMg) throws com.irurueta.navigation.LockedException
      Sets initial scale factors and cross coupling errors matrix.
      Specified by:
      setInitialMg in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialMg - 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.

    • getInitialGg

      public com.irurueta.algebra.Matrix getInitialGg()
      Gets initial G-dependent cross biases introduced on the gyroscope by the specific forces sensed by the accelerometer.
      Specified by:
      getInitialGg in interface GyroscopeNonLinearCalibrator
      Returns:
      a 3x3 matrix containing initial g-dependent cross biases.

    • getInitialGg

      public void getInitialGg(com.irurueta.algebra.Matrix result)
      Gets initial G-dependent cross biases introduced on the gyroscope by the specific forces sensed by the accelerometer.
      Specified by:
      getInitialGg in interface GyroscopeNonLinearCalibrator
      Parameters:
      result - instance where data will be stored.
      Throws:
      IllegalArgumentException - if provided matrix is not 3x3.

    • setInitialGg

      public void setInitialGg(com.irurueta.algebra.Matrix initialGg) throws com.irurueta.navigation.LockedException
      Sets initial G-dependent cross biases introduced on the gyroscope by the specific forces sensed by the accelerometer.
      Specified by:
      setInitialGg in interface GyroscopeNonLinearCalibrator
      Parameters:
      initialGg - g-dependent cross biases.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
      IllegalArgumentException - if provided matrix is not 3x3.

    • getMeasurements

      public Collection<StandardDeviationFrameBodyKinematics> getMeasurements()
      Gets a collection of body kinematics measurements taken at different frames (positions, orientations and velocities) and containing the standard deviations of accelerometer and gyroscope measurements. If a single device IMU needs to be calibrated, typically all measurements are taken at the same position, with zero velocity and multiple orientations. However, if we just want to calibrate a given IMU model (e.g. obtain an average and less precise calibration for the IMU of a given phone model), we could take measurements collected throughout the planet at multiple positions while the phone remains static (e.g. while charging), hence each measurement position will change, velocity will remain zero and orientation will be typically constant at horizontal orientation while the phone remains on a flat surface.
      Specified by:
      getMeasurements in interface KnownFrameGyroscopeCalibrator<StandardDeviationFrameBodyKinematics,KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener>
      Specified by:
      getMeasurements in interface UnorderedStandardDeviationFrameBodyKinematicsGyroscopeCalibrator
      Returns:
      a collection of body kinematics measurements taken at different frames (positions, orientations and velocities).

    • setMeasurements

      public void setMeasurements(Collection<? extends StandardDeviationFrameBodyKinematics> measurements) throws com.irurueta.navigation.LockedException
      Sets a collection of body kinematics measurements taken at different frames (positions, orientations and velocities) and containing the standard deviations of accelerometer and gyroscope measurements. If a single device IMU needs to be calibrated, typically all measurements are taken at the same position, with zero velocity and multiple orientations. However, if we just want to calibrate a given IMU model (e.g. obtain an average and less precise calibration for the IMU of a given phone model), we could take measurements collected throughout the planet at multiple positions while the phone remains static (e.g. while charging), hence each measurement position will change, velocity will remain zero and orientation will be typically constant at horizontal orientation while the phone remains on a flat surface.
      Specified by:
      setMeasurements in interface KnownFrameGyroscopeCalibrator<StandardDeviationFrameBodyKinematics,KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener>
      Specified by:
      setMeasurements in interface UnorderedStandardDeviationFrameBodyKinematicsGyroscopeCalibrator
      Parameters:
      measurements - collection of body kinematics measurements taken at different frames (positions, orientations and velocities).
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getMeasurementOrSequenceType

      public GyroscopeCalibratorMeasurementOrSequenceType getMeasurementOrSequenceType()
      Indicates the type of measurement or sequence used by this calibrator.
      Specified by:
      getMeasurementOrSequenceType in interface GyroscopeCalibrator
      Returns:
      type of measurement or sequence used by this calibrator.

    • isOrderedMeasurementsOrSequencesRequired

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

    • isQualityScoresRequired

      public boolean isQualityScoresRequired()
      Indicates whether this calibrator requires quality scores for each measurement/sequence or not.
      Specified by:
      isQualityScoresRequired in interface GyroscopeCalibrator
      Returns:
      true if quality scores are required, 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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      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

      public KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener getListener()
      Gets listener to handle events raised by this estimator.
      Specified by:
      getListener in interface KnownFrameGyroscopeCalibrator<StandardDeviationFrameBodyKinematics,KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener>
      Returns:
      listener to handle events raised by this estimator.

    • setListener

      public void setListener(KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener listener) throws com.irurueta.navigation.LockedException
      Sets listener to handle events raised by this estimator.
      Specified by:
      setListener in interface KnownFrameGyroscopeCalibrator<StandardDeviationFrameBodyKinematics,KnownFrameGyroscopeNonLinearLeastSquaresCalibratorListener>
      Parameters:
      listener - listener to handle events raised by this estimator.
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.

    • getMinimumRequiredMeasurementsOrSequences

      public int getMinimumRequiredMeasurementsOrSequences()
      Gets minimum number of required measurements.
      Specified by:
      getMinimumRequiredMeasurementsOrSequences in interface GyroscopeCalibrator
      Returns:
      minimum number of required measurements.

    • isReady

      public boolean isReady()
      Indicates whether calibrator is ready to start.
      Specified by:
      isReady in interface GyroscopeCalibrator
      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 GyroscopeCalibrator
      Returns:
      true if calibrator is running, false otherwise.

    • calibrate

      public void calibrate() throws com.irurueta.navigation.LockedException, com.irurueta.navigation.NotReadyException, CalibrationException
      Estimates gyroscope calibration parameters containing bias, scale factors, cross-coupling errors and G-dependent coupling.
      Specified by:
      calibrate in interface GyroscopeCalibrator
      Throws:
      com.irurueta.navigation.LockedException - if calibrator is currently running.
      com.irurueta.navigation.NotReadyException - if calibrator is not ready.
      CalibrationException - if estimation fails for numerical reasons.

    • getEstimatedBiases

      public double[] getEstimatedBiases()
      Gets array containing x,y,z components of estimated gyroscope biases expressed in radians per second (rad/s).
      Specified by:
      getEstimatedBiases in interface GyroscopeCalibrationSource
      Specified by:
      getEstimatedBiases in interface UnknownBiasGyroscopeCalibrator
      Returns:
      array containing x,y,z components of estimated gyroscope biases.

    • getEstimatedBiases

      public boolean getEstimatedBiases(double[] result)
      Gets array containing x,y,z components of estimated gyroscope biases expressed in radians per second (rad/s).
      Specified by:
      getEstimatedBiases in interface UnknownBiasGyroscopeCalibrator
      Parameters:
      result - instance where estimated gyroscope biases will be stored.
      Returns:
      true if result instance was updated, false otherwise (when estimation is not yet available).

    • getEstimatedBiasesAsMatrix

      public com.irurueta.algebra.Matrix getEstimatedBiasesAsMatrix()
      Gets column matrix containing x,y,z components of estimated gyroscope biases expressed in radians per second (rad/s).
      Specified by:
      getEstimatedBiasesAsMatrix in interface UnknownBiasGyroscopeCalibrator
      Returns:
      column matrix containing x,y,z components of estimated gyroscope biases.

    • getEstimatedBiasesAsMatrix

      public boolean getEstimatedBiasesAsMatrix(com.irurueta.algebra.Matrix result) throws com.irurueta.algebra.WrongSizeException
      Gets column matrix containing x,y,z components of estimated gyroscope biases expressed in radians per second (rad/s).
      Specified by:
      getEstimatedBiasesAsMatrix in interface UnknownBiasGyroscopeCalibrator
      Parameters:
      result - instance where result data will be stored.
      Returns:
      true if result was updated, false otherwise.
      Throws:
      com.irurueta.algebra.WrongSizeException - if provided result instance has invalid size.

    • getEstimatedBiasX

      public Double getEstimatedBiasX()
      Gets x coordinate of estimated gyroscope bias expressed in radians per second (rad/s).
      Specified by:
      getEstimatedBiasX in interface UnknownBiasGyroscopeCalibrator
      Returns:
      x coordinate of estimated gyroscope bias or null if not available.

    • getEstimatedBiasY

      public Double getEstimatedBiasY()
      Gets y coordinate of estimated gyroscope bias expressed in radians per second (rad/s).
      Specified by:
      getEstimatedBiasY in interface UnknownBiasGyroscopeCalibrator
      Returns:
      y coordinate of estimated gyroscope bias or null if not available.

    • getEstimatedBiasZ

      public Double getEstimatedBiasZ()
      Gets z coordinate of estimated gyroscope bias expressed in radians per second (rad/s).
      Specified by:
      getEstimatedBiasZ in interface UnknownBiasGyroscopeCalibrator
      Returns:
      z coordinate of estimated gyroscope bias or null if not available.

    • getEstimatedBiasAngularSpeedX

      public com.irurueta.units.AngularSpeed getEstimatedBiasAngularSpeedX()
      Gets x coordinate of estimated gyroscope bias.
      Specified by:
      getEstimatedBiasAngularSpeedX in interface UnknownBiasGyroscopeCalibrator
      Returns:
      x coordinate of estimated gyroscope bias or null if not available.

    • getEstimatedBiasAngularSpeedX

      public boolean getEstimatedBiasAngularSpeedX(com.irurueta.units.AngularSpeed result)
      Gets x coordinate of estimated gyroscope bias.
      Specified by:
      getEstimatedBiasAngularSpeedX in interface UnknownBiasGyroscopeCalibrator
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if result was updated, false if estimation is not available.

    • getEstimatedBiasAngularSpeedY

      public com.irurueta.units.AngularSpeed getEstimatedBiasAngularSpeedY()
      Gets y coordinate of estimated gyroscope bias.
      Specified by:
      getEstimatedBiasAngularSpeedY in interface UnknownBiasGyroscopeCalibrator
      Returns:
      y coordinate of estimated gyroscope bias or null if not available.

    • getEstimatedBiasAngularSpeedY

      public boolean getEstimatedBiasAngularSpeedY(com.irurueta.units.AngularSpeed result)
      Gets y coordinate of estimated gyroscope bias.
      Specified by:
      getEstimatedBiasAngularSpeedY in interface UnknownBiasGyroscopeCalibrator
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if result was updated, false if estimation is not available.

    • getEstimatedBiasAngularSpeedZ

      public com.irurueta.units.AngularSpeed getEstimatedBiasAngularSpeedZ()
      Gets z coordinate of estimated gyroscope bias.
      Specified by:
      getEstimatedBiasAngularSpeedZ in interface UnknownBiasGyroscopeCalibrator
      Returns:
      z coordinate of estimated gyroscope bias or null if not available.

    • getEstimatedBiasAngularSpeedZ

      public boolean getEstimatedBiasAngularSpeedZ(com.irurueta.units.AngularSpeed result)
      Gets z coordinate of estimated gyroscope bias.
      Specified by:
      getEstimatedBiasAngularSpeedZ in interface UnknownBiasGyroscopeCalibrator
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if result was updated, false if estimation is not available.

    • getEstimatedBiasAsTriad

      public AngularSpeedTriad getEstimatedBiasAsTriad()
      Gets estimated gyroscope bias.
      Specified by:
      getEstimatedBiasAsTriad in interface UnknownBiasGyroscopeCalibrator
      Returns:
      estimated gyroscope bias or null if not available.

    • getEstimatedBiasAsTriad

      public boolean getEstimatedBiasAsTriad(AngularSpeedTriad result)
      Gets estimated gyroscope bias.
      Specified by:
      getEstimatedBiasAsTriad in interface UnknownBiasGyroscopeCalibrator
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if estimated gyroscope bias is available and result was modified, false otherwise.

    • getEstimatedMg

      public com.irurueta.algebra.Matrix getEstimatedMg()
      Gets estimated gyroscope scale factors and cross coupling errors. This is the product of matrix Tg containing cross coupling errors and Kg containing scaling factors. So that: 
           Mg = [sx    mxy  mxz] = Tg*Kg
          [myx   sy   myz]
          [mzx   mzy  sz ]
      Where: 
           Kg = [sx 0   0 ]
          [0  sy  0 ]
          [0  0   sz]
      and 
           Tg = [1          -alphaXy    alphaXz ]
          [alphaYx    1           -alphaYz]
          [-alphaZx   alphaZy     1       ]
      Hence: 
           Mg = [sx    mxy  mxz] = Tg*Kg =  [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 gyroscope z-axis is assumed to be the same as the body z-axis. When this is assumed, myx = mzx = mzy = 0 and the Mg matrix becomes upper diagonal: 
           Mg = [sx    mxy  mxz]
          [0     sy   myz]
          [0     0    sz ]
      Values of this matrix are unit-less.
      Specified by:
      getEstimatedMg in interface GyroscopeCalibrationSource
      Specified by:
      getEstimatedMg in interface GyroscopeCalibrator
      Returns:
      estimated gyroscope 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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      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 GyroscopeCalibrator
      Returns:
      estimated z-y cross-coupling error or null if not available.

    • getEstimatedGg

      public com.irurueta.algebra.Matrix getEstimatedGg()
      Gets estimated G-dependent cross biases introduced on the gyroscope by the specific forces sensed by the accelerometer. This instance allows any 3x3 matrix.
      Specified by:
      getEstimatedGg in interface GyroscopeCalibrationSource
      Specified by:
      getEstimatedGg in interface GyroscopeCalibrator
      Returns:
      estimated G-dependent cross biases.

    • getEstimatedCovariance

      public com.irurueta.algebra.Matrix getEstimatedCovariance()
      Gets estimated covariance matrix for estimated parameters. Diagonal elements of the matrix contains variance for the following parameters (following indicated order): bgx, bgy, bgz, sx, sy, sz, mxy, mxz, myx, myz, mzx, mzy, gg11, gg21, gg31, gg12, gg22, gg32, gg13, gg23, gg33.
      Specified by:
      getEstimatedCovariance in interface GyroscopeNonLinearCalibrator
      Returns:
      estimated covariance matrix for estimated parameters.

    • getEstimatedChiSq

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

    • getEstimatedChiSqDegreesOfFreedom

      public int getEstimatedChiSqDegreesOfFreedom()
      Gets estimated chi square degrees of freedom. Degrees of freedom is equal to the number of sampled data minus the number of estimated parameters.
      Specified by:
      getEstimatedChiSqDegreesOfFreedom in interface GyroscopeNonLinearCalibrator
      Returns:
      estimated degrees of freedom of chi square value

    • getEstimatedReducedChiSq

      public double getEstimatedReducedChiSq()
      Gets estimated reduced chi square value. This is equal to estimated chi square value divided by its degrees of freedom. Ideally this value should be close to 1.0, indicating that fit is optimal. A value larger than 1.0 indicates that fit is not good or noise has been underestimated, and a value smaller than 1.0 indicates that there is overfitting or noise has been overestimated.
      Specified by:
      getEstimatedReducedChiSq in interface GyroscopeNonLinearCalibrator
      Returns:
      estimated reduced chi square value

    • getEstimatedMse

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

    • getEstimatedP

      public double getEstimatedP()
      Gets estimated probability of finding a smaller chi square value expressed as a value between 0.0 and 1.0. The smaller the found chi square value is, the better the fit of the estimated parameters to the actual parameter. Thus, the smaller the chance of finding a smaller chi square value, then the better the estimated fit is.
      Specified by:
      getEstimatedP in interface GyroscopeNonLinearCalibrator
      Returns:
      estimated probability of finding a smaller chi square value.

    • getEstimatedQ

      public double getEstimatedQ()
      Gets estimated measure of quality of estimated fit as a value between 0.0 and 1.0. The larger the quality value is, the better the fit that has been estimated.
      Specified by:
      getEstimatedQ in interface GyroscopeNonLinearCalibrator
      Returns:
      estimated measure of quality of estimated fit.

    • getEstimatedBiasXVariance

      public Double getEstimatedBiasXVariance()
      Gets variance of estimated x coordinate of gyroscope bias expressed in (rad^2/s^2).
      Returns:
      variance of estimated x coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasXStandardDeviation

      public Double getEstimatedBiasXStandardDeviation()
      Gets standard deviation of estimated x coordinate of gyroscope bias expressed in radians per second (rad/s).
      Returns:
      standard deviation of estimated x coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasXStandardDeviationAsAngularSpeed

      public com.irurueta.units.AngularSpeed getEstimatedBiasXStandardDeviationAsAngularSpeed()
      Gets standard deviation of estimated x coordinate of gyroscope bias.
      Returns:
      standard deviation of estimated x coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasXStandardDeviationAsAngularSpeed

      public boolean getEstimatedBiasXStandardDeviationAsAngularSpeed(com.irurueta.units.AngularSpeed result)
      Gets standard deviation of estimated x coordinate of gyroscope bias.
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if standard deviation of estimated x coordinate of gyroscope bias is available, false otherwise.

    • getEstimatedBiasYVariance

      public Double getEstimatedBiasYVariance()
      Gets variance of estimated y coordinate of gyroscope bias expressed in (rad^2/s^2).
      Returns:
      variance of estimated y coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasYStandardDeviation

      public Double getEstimatedBiasYStandardDeviation()
      Gets standard deviation of estimated y coordinate of gyroscope bias expressed in radians per second (rad/s).
      Returns:
      standard deviation of estimated y coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasYStandardDeviationAsAngularSpeed

      public com.irurueta.units.AngularSpeed getEstimatedBiasYStandardDeviationAsAngularSpeed()
      Gets standard deviation of estimated y coordinate of gyroscope bias.
      Returns:
      standard deviation of estimated y coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasYStandardDeviationAsAngularSpeed

      public boolean getEstimatedBiasYStandardDeviationAsAngularSpeed(com.irurueta.units.AngularSpeed result)
      Gets standard deviation of estimated y coordinate of gyroscope bias.
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if standard deviation of estimated y coordinate of gyroscope bias is available, false otherwise.

    • getEstimatedBiasZVariance

      public Double getEstimatedBiasZVariance()
      Gets variance of estimated z coordinate of gyroscope bias expressed in (rad^2/s^2).
      Returns:
      variance of estimated z coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasZStandardDeviation

      public Double getEstimatedBiasZStandardDeviation()
      Gets standard deviation of estimated z coordinate of gyroscope bias expressed in radians per second (rad/s).
      Returns:
      standard deviation of estimated z coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasZStandardDeviationAsAngularSpeed

      public com.irurueta.units.AngularSpeed getEstimatedBiasZStandardDeviationAsAngularSpeed()
      Gets standard deviation of estimated z coordinate of gyroscope bias.
      Returns:
      standard deviation of estimated z coordinate of gyroscope bias or null if not available.

    • getEstimatedBiasZStandardDeviationAsAngularSpeed

      public boolean getEstimatedBiasZStandardDeviationAsAngularSpeed(com.irurueta.units.AngularSpeed result)
      Gets standard deviation of estimated z coordinate of gyroscope bias.
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if standard deviation of estimated z coordinate of gyroscope bias is available, false otherwise.

    • getEstimatedBiasStandardDeviation

      public AngularSpeedTriad getEstimatedBiasStandardDeviation()
      Gets standard deviation of estimated gyroscope bias coordinates.
      Returns:
      standard deviation of estimated gyroscope bias coordinates.

    • getEstimatedBiasStandardDeviation

      public boolean getEstimatedBiasStandardDeviation(AngularSpeedTriad result)
      Gets standard deviation of estimated gyroscope bias coordinates.
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if standard deviation of gyroscope bias was available, false otherwise.

    • getEstimatedBiasStandardDeviationAverage

      public Double getEstimatedBiasStandardDeviationAverage()
      Gets average of estimated standard deviation of gyroscope bias coordinates expressed in radians per second (rad/s).
      Returns:
      average of estimated standard deviation of gyroscope bias coordinates or null if not available.

    • getEstimatedBiasStandardDeviationAverageAsAngularSpeed

      public com.irurueta.units.AngularSpeed getEstimatedBiasStandardDeviationAverageAsAngularSpeed()
      Gets average of estimated standard deviation of gyroscope bias coordinates.
      Returns:
      average of estimated standard deviation of gyroscope bias coordinates or null.

    • getEstimatedBiasStandardDeviationAverageAsAngularSpeed

      public boolean getEstimatedBiasStandardDeviationAverageAsAngularSpeed(com.irurueta.units.AngularSpeed result)
      Gets average of estimated standard deviation of gyroscope bias coordinates.
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if average of estimated standard deviation of gyroscope bias is available, false otherwise.

    • getEstimatedBiasStandardDeviationNorm

      public Double getEstimatedBiasStandardDeviationNorm()
      Gets norm of estimated standard deviation of gyroscope bias expressed in radians per second (rad/s). This can be used as the initial gyroscope bias uncertainty for INSLooselyCoupledKalmanInitializerConfig or INSTightlyCoupledKalmanInitializerConfig.
      Specified by:
      getEstimatedBiasStandardDeviationNorm in interface GyroscopeBiasUncertaintySource
      Returns:
      norm of estimated standard deviation of gyroscope bias or null if not available.

    • getEstimatedBiasStandardDeviationNormAsAngularSpeed

      public com.irurueta.units.AngularSpeed getEstimatedBiasStandardDeviationNormAsAngularSpeed()
      Gets norm of estimated standard deviation of gyroscope bias. This can be used as the initial gyroscope bias uncertainty for INSLooselyCoupledKalmanInitializerConfig or INSTightlyCoupledKalmanInitializerConfig.
      Returns:
      norm of estimated standard deviation of gyroscope bias or null if not available.

    • getEstimatedBiasStandardDeviationNormAsAngularSpeed

      public boolean getEstimatedBiasStandardDeviationNormAsAngularSpeed(com.irurueta.units.AngularSpeed result)
      Gets norm of estimated standard deviation of gyroscope bias coordinates. This can be used as the initial gyroscope bias uncertainty for INSLooselyCoupledKalmanInitializerConfig or INSTightlyCoupledKalmanInitializerConfig.
      Parameters:
      result - instance where result will be stored.
      Returns:
      true if norm of estimated standard deviation of gyroscope bias is available, false otherwise.

    • calibrateCommonAxis

      private void calibrateCommonAxis() throws com.irurueta.algebra.AlgebraException, com.irurueta.numerical.fitting.FittingException, com.irurueta.numerical.NotReadyException
      Internal method to perform calibration when common z-axis is assumed for both the accelerometer and gyroscope.
      Throws:
      com.irurueta.algebra.AlgebraException - if there are numerical errors.
      com.irurueta.numerical.fitting.FittingException - if no convergence to solution is found.
      com.irurueta.numerical.NotReadyException - if fitter is not ready.

    • calibrateGeneral

      private void calibrateGeneral() throws com.irurueta.algebra.AlgebraException, com.irurueta.numerical.fitting.FittingException, com.irurueta.numerical.NotReadyException
      Internal method to perform general calibration.
      Throws:
      com.irurueta.algebra.AlgebraException - if there are numerical errors.
      com.irurueta.numerical.fitting.FittingException - if no convergence to solution is found.
      com.irurueta.numerical.NotReadyException - if fitter is not ready.

    • setInputData

      private void setInputData() throws com.irurueta.algebra.WrongSizeException
      Sets input data into Levenberg-Marquardt fitter.
      Throws:
      com.irurueta.algebra.WrongSizeException - never happens.

    • convertAngularSpeed

      private static double convertAngularSpeed(double value, com.irurueta.units.AngularSpeedUnit unit)
      Converts angular speed value and unit to radians per second.
      Parameters:
      value - angular speed value.
      unit - unit of angular speed value.
      Returns:
      converted value.

    • convertAngularSpeed

      private static double convertAngularSpeed(com.irurueta.units.AngularSpeed angularSpeed)
      Converts angular speed instance to radians per second.
      Parameters:
      angularSpeed - angular speed instance to be converted.
      Returns:
      converted value.