Below is partly generated with ChatGPT 4o, needs to be verified.
Overview¶
The WhiteNoiseFactor
in GTSAM is a binary nonlinear factor designed to estimate the parameters of zero-mean Gaussian white noise. It uses a mean-precision parameterization, where the mean and precision are treated as variables to be optimized.
Parameterization¶
The factor models the negative log-likelihood of a zero-mean Gaussian distribution as follows,
where:
- : Measurement value (observed data).
- : Mean of the Gaussian distribution (to be estimated).
- : Precision of the Gaussian distribution , also to be estimated).
This formulation allows the factor to optimize both the mean and precision of the noise model simultaneously.
Use Case: Estimating IMU Noise Characteristics¶
The WhiteNoiseFactor
can be used in system identification tasks, such as estimating the noise characteristics of an IMU. Here’s how it would work:
Define the Measurement:
- Collect a series of IMU measurements (e.g., accelerometer or gyroscope readings) under known conditions (e.g., stationary or constant velocity).
Set Up the Factor Graph:
- Add
WhiteNoiseFactor
instances to the factor graph for each measurement, linking the observed value to the mean and precision variables.
- Add
Optimize the Graph:
- Use GTSAM’s nonlinear optimization tools to solve for the mean and precision that best explain the observed measurements.
Extract Noise Characteristics:
- The optimized mean represents the bias in the sensor measurements.
- The optimized precision can be inverted to compute the standard deviation , which represents the noise level.