Class MagnetometerMeasurementGeneratorTest
java.lang.Object
com.irurueta.navigation.inertial.calibration.generators.MagnetometerMeasurementGeneratorTest
- All Implemented Interfaces:
MagnetometerMeasurementsGeneratorListener,MeasurementsGeneratorListener<StandardDeviationBodyMagneticFluxDensity,MagnetometerMeasurementsGenerator, MagnetometerMeasurementsGeneratorListener, BodyKinematicsAndMagneticFluxDensity>
class MagnetometerMeasurementGeneratorTest
extends Object
implements MagnetometerMeasurementsGeneratorListener
-
Field Summary
FieldsModifier and TypeFieldDescriptionprivate static final doubleprivate static final doubleprivate intprivate static final Calendarprivate static final longprivate intprivate intprivate intprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate intprivate final List<StandardDeviationBodyMagneticFluxDensity> private intprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate static final doubleprivate intprivate static final doubleprivate static final Calendarprivate static final longprivate intprivate intprivate static final doubleprivate static final intprivate static final double -
Constructor Summary
Constructors -
Method Summary
Modifier and TypeMethodDescriptionprivate voidcheckLocked(MagnetometerMeasurementsGenerator generator) private static com.irurueta.navigation.frames.NEDPositioncreatePosition(com.irurueta.statistics.UniformRandomizer randomizer) private static longcreateTimestamp(com.irurueta.statistics.UniformRandomizer randomizer) private static BodyMagneticFluxDensitygenerateB(double[] hardIron, com.irurueta.algebra.Matrix softIron, WMMEarthMagneticFluxDensityEstimator wmmEstimator, com.irurueta.statistics.GaussianRandomizer noiseRandomizer, Date timestamp, com.irurueta.navigation.frames.NEDPosition position, com.irurueta.navigation.frames.CoordinateTransformation cnb) private static com.irurueta.algebra.Matrixprivate static com.irurueta.algebra.Matrixprivate static com.irurueta.navigation.frames.CoordinateTransformationgenerateBodyC(com.irurueta.statistics.UniformRandomizer randomizer) private static voidgenerateDynamicSamples(MagnetometerMeasurementsGenerator generator, int numSamples, BodyKinematics trueKinematics, com.irurueta.statistics.UniformRandomizer randomizer, com.irurueta.navigation.frames.ECEFFrame ecefFrame, com.irurueta.navigation.frames.NEDFrame nedFrame, IMUErrors errors, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix mm, WMMEarthMagneticFluxDensityEstimator wmmEstimator, Date timestamp, com.irurueta.navigation.frames.NEDPosition nedPosition, com.irurueta.navigation.frames.CoordinateTransformation cnb, com.irurueta.statistics.GaussianRandomizer noiseRandomizer, boolean changePosition) private static com.irurueta.algebra.Matrixprivate static double[]generateHardIron(com.irurueta.statistics.UniformRandomizer randomizer) private static com.irurueta.algebra.Matrixprivate static BodyMagneticFluxDensitygenerateMeasuredMagneticFluxDensity(BodyMagneticFluxDensity input, double[] hardIron, com.irurueta.algebra.Matrix softIron) private static com.irurueta.algebra.Matrixprivate static com.irurueta.algebra.Matrixprivate static com.irurueta.algebra.Matrixprivate static voidgenerateStaticSamples(MagnetometerMeasurementsGenerator generator, int numSamples, BodyKinematics trueKinematics, IMUErrors errors, com.irurueta.algebra.Matrix hardIron, com.irurueta.algebra.Matrix mm, WMMEarthMagneticFluxDensityEstimator wmmEstimator, Date timestamp, com.irurueta.navigation.frames.NEDPosition nedPosition, com.irurueta.navigation.frames.CoordinateTransformation cnb, com.irurueta.statistics.GaussianRandomizer noiseRandomizer) private static doubleprivate static doublevoidvoidvoidonError(MagnetometerMeasurementsGenerator generator, TriadStaticIntervalDetector.ErrorReason reason) voidonGeneratedMeasurement(MagnetometerMeasurementsGenerator generator, StandardDeviationBodyMagneticFluxDensity measurement) voidonInitializationCompleted(MagnetometerMeasurementsGenerator generator, double baseNoiseLevel) voidvoidonReset(MagnetometerMeasurementsGenerator generator) voidvoidprivate voidreset()(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void(package private) void
-
Field Details
-
TIME_INTERVAL_SECONDS
private static final double TIME_INTERVAL_SECONDS- See Also:
-
MICRO_G_TO_METERS_PER_SECOND_SQUARED
private static final double MICRO_G_TO_METERS_PER_SECOND_SQUARED- See Also:
-
DEG_TO_RAD
private static final double DEG_TO_RAD- See Also:
-
MIN_HARD_IRON
private static final double MIN_HARD_IRON- See Also:
-
MAX_HARD_IRON
private static final double MAX_HARD_IRON- See Also:
-
MIN_SOFT_IRON
private static final double MIN_SOFT_IRON- See Also:
-
MAX_SOFT_IRON
private static final double MAX_SOFT_IRON- See Also:
-
MIN_ANGLE_DEGREES
private static final double MIN_ANGLE_DEGREES- See Also:
-
MAX_ANGLE_DEGREES
private static final double MAX_ANGLE_DEGREES- See Also:
-
MIN_LATITUDE_DEGREES
private static final double MIN_LATITUDE_DEGREES- See Also:
-
MAX_LATITUDE_DEGREES
private static final double MAX_LATITUDE_DEGREES- See Also:
-
MIN_LONGITUDE_DEGREES
private static final double MIN_LONGITUDE_DEGREES- See Also:
-
MAX_LONGITUDE_DEGREES
private static final double MAX_LONGITUDE_DEGREES- See Also:
-
MIN_HEIGHT_METERS
private static final double MIN_HEIGHT_METERS- See Also:
-
MAX_HEIGHT_METERS
private static final double MAX_HEIGHT_METERS- See Also:
-
SMALL_MAGNETOMETER_NOISE_STD
private static final double SMALL_MAGNETOMETER_NOISE_STD- See Also:
-
MAGNETOMETER_NOISE_STD
private static final double MAGNETOMETER_NOISE_STD- See Also:
-
MIN_DELTA_POS_METERS
private static final double MIN_DELTA_POS_METERS- See Also:
-
MAX_DELTA_POS_METERS
private static final double MAX_DELTA_POS_METERS- See Also:
-
MIN_DELTA_ANGLE_DEGREES
private static final double MIN_DELTA_ANGLE_DEGREES- See Also:
-
MAX_DELTA_ANGLE_DEGREES
private static final double MAX_DELTA_ANGLE_DEGREES- See Also:
-
TIMES
private static final int TIMES- See Also:
-
ABSOLUTE_ERROR
private static final double ABSOLUTE_ERROR- See Also:
-
LARGE_ABSOLUTE_ERROR
private static final double LARGE_ABSOLUTE_ERROR- See Also:
-
VERY_LARGE_ABSOLUTE_ERROR
private static final double VERY_LARGE_ABSOLUTE_ERROR- See Also:
-
START_CALENDAR
-
END_CALENDAR
-
START_TIMESTAMP_MILLIS
private static final long START_TIMESTAMP_MILLIS -
END_TIMESTAMP_MILLIS
private static final long END_TIMESTAMP_MILLIS -
initializationStarted
private int initializationStarted -
initializationCompleted
private int initializationCompleted -
error
private int error -
staticIntervalDetected
private int staticIntervalDetected -
dynamicIntervalDetected
private int dynamicIntervalDetected -
staticIntervalSkipped
private int staticIntervalSkipped -
mDynamicIntervalSkipped
private int mDynamicIntervalSkipped -
mGeneratedMeasurement
private int mGeneratedMeasurement -
reset
private int reset -
measurements
-
-
Constructor Details
-
MagnetometerMeasurementGeneratorTest
MagnetometerMeasurementGeneratorTest()
-
-
Method Details
-
testConstructor1
@Test void testConstructor1() -
testConstructor2
@Test void testConstructor2() -
testGetSetMinStaticSamples
@Test void testGetSetMinStaticSamples() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testGetSetMaxDynamicSamples
@Test void testGetSetMaxDynamicSamples() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testGetSetListener
@Test void testGetSetListener() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testGetSetWindowSize
@Test void testGetSetWindowSize() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testGetSetInitialStaticSamples
@Test void testGetSetInitialStaticSamples() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testGetSetThresholdFactor
@Test void testGetSetThresholdFactor() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testGetSetInstantaneousNoiseLevelFactor
@Test void testGetSetInstantaneousNoiseLevelFactor() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testGetSetBaseNoiseLevelAbsoluteThreshold
@Test void testGetSetBaseNoiseLevelAbsoluteThreshold() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testGetSetBaseNoiseLevelAbsoluteThresholdAsMeasurement
@Test void testGetSetBaseNoiseLevelAbsoluteThresholdAsMeasurement() throws com.irurueta.navigation.LockedException- Throws:
com.irurueta.navigation.LockedException
-
testProcessCalibrateAndResetWithSmallNoiseAndCommonAxis
@Test void testProcessCalibrateAndResetWithSmallNoiseAndCommonAxis() throws com.irurueta.algebra.WrongSizeException, com.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeException, com.irurueta.navigation.LockedException, com.irurueta.navigation.NotReadyException, IOException- Throws:
com.irurueta.algebra.WrongSizeExceptioncom.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeExceptioncom.irurueta.navigation.LockedExceptioncom.irurueta.navigation.NotReadyExceptionIOException
-
testProcessCalibrateAndResetWithSmallNoiseAndGeneralCase
@Test void testProcessCalibrateAndResetWithSmallNoiseAndGeneralCase() throws com.irurueta.algebra.WrongSizeException, com.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeException, com.irurueta.navigation.LockedException, com.irurueta.navigation.NotReadyException, IOException- Throws:
com.irurueta.algebra.WrongSizeExceptioncom.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeExceptioncom.irurueta.navigation.LockedExceptioncom.irurueta.navigation.NotReadyExceptionIOException
-
testProcessCalibrateAndResetWithNoiseAndCommonAxis
@Test void testProcessCalibrateAndResetWithNoiseAndCommonAxis() throws com.irurueta.algebra.WrongSizeException, com.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeException, com.irurueta.navigation.LockedException, com.irurueta.navigation.NotReadyException, IOException- Throws:
com.irurueta.algebra.WrongSizeExceptioncom.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeExceptioncom.irurueta.navigation.LockedExceptioncom.irurueta.navigation.NotReadyExceptionIOException
-
testProcessCalibrateAndResetWithNoiseAndGeneralCase
@Test void testProcessCalibrateAndResetWithNoiseAndGeneralCase() throws com.irurueta.algebra.WrongSizeException, com.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeException, com.irurueta.navigation.LockedException, com.irurueta.navigation.NotReadyException, IOException- Throws:
com.irurueta.algebra.WrongSizeExceptioncom.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeExceptioncom.irurueta.navigation.LockedExceptioncom.irurueta.navigation.NotReadyExceptionIOException
-
testProcessSmallNoiseWithRotationAndPositionChange
@Test void testProcessSmallNoiseWithRotationAndPositionChange() throws com.irurueta.algebra.WrongSizeException, com.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeException, com.irurueta.navigation.LockedException, com.irurueta.navigation.NotReadyException, IOException- Throws:
com.irurueta.algebra.WrongSizeExceptioncom.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeExceptioncom.irurueta.navigation.LockedExceptioncom.irurueta.navigation.NotReadyExceptionIOException
-
testProcessErrorWithExcessiveOverallNoise
@Test void testProcessErrorWithExcessiveOverallNoise() throws com.irurueta.algebra.WrongSizeException, com.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeException, com.irurueta.navigation.LockedException, IOException- Throws:
com.irurueta.algebra.WrongSizeExceptioncom.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeExceptioncom.irurueta.navigation.LockedExceptionIOException
-
testProcessSkipStaticInterval
@Test void testProcessSkipStaticInterval() throws com.irurueta.algebra.WrongSizeException, com.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeException, com.irurueta.navigation.LockedException, IOException- Throws:
com.irurueta.algebra.WrongSizeExceptioncom.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeExceptioncom.irurueta.navigation.LockedExceptionIOException
-
testProcessSkipDynamicInterval
@Test void testProcessSkipDynamicInterval() throws com.irurueta.algebra.WrongSizeException, com.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeException, com.irurueta.navigation.LockedException, IOException- Throws:
com.irurueta.algebra.WrongSizeExceptioncom.irurueta.navigation.frames.InvalidSourceAndDestinationFrameTypeExceptioncom.irurueta.navigation.LockedExceptionIOException
-
reset
private void reset() -
generateBodyC
private static com.irurueta.navigation.frames.CoordinateTransformation generateBodyC(com.irurueta.statistics.UniformRandomizer randomizer) -
generateHardIron
private static double[] generateHardIron(com.irurueta.statistics.UniformRandomizer randomizer) -
generateSoftIronCommonAxis
private static com.irurueta.algebra.Matrix generateSoftIronCommonAxis() -
generateSoftIronGeneral
private static com.irurueta.algebra.Matrix generateSoftIronGeneral() -
createPosition
private static com.irurueta.navigation.frames.NEDPosition createPosition(com.irurueta.statistics.UniformRandomizer randomizer) -
createTimestamp
private static long createTimestamp(com.irurueta.statistics.UniformRandomizer randomizer) -
generateBa
private static com.irurueta.algebra.Matrix generateBa() -
generateBg
private static com.irurueta.algebra.Matrix generateBg() -
generateMaCommonAxis
private static com.irurueta.algebra.Matrix generateMaCommonAxis() throws com.irurueta.algebra.WrongSizeException- Throws:
com.irurueta.algebra.WrongSizeException
-
generateMg
private static com.irurueta.algebra.Matrix generateMg() throws com.irurueta.algebra.WrongSizeException- Throws:
com.irurueta.algebra.WrongSizeException
-
generateGg
private static com.irurueta.algebra.Matrix generateGg() throws com.irurueta.algebra.WrongSizeException- Throws:
com.irurueta.algebra.WrongSizeException
-
getAccelNoiseRootPSD
private static double getAccelNoiseRootPSD() -
getGyroNoiseRootPSD
private static double getGyroNoiseRootPSD()
-