Skip to main content

optimize_imu_trajectory

Function optimize_imu_trajectory 

Source
pub fn optimize_imu_trajectory(
    initial_states: &[NavState],
    initial_bias: ImuBias,
    measurements: &[PreintegratedImuMeasurement],
    gravity: Vector3<f64>,
    config: &ImuTrajectoryConfig,
) -> OptimizationResult<ImuTrajectoryResult>
Expand description

Jointly refines a navigation-state sequence and one bias per keyframe.

The first state and bias receive priors, each preintegrated interval adds an ImuFactor, and consecutive biases receive a random-walk constraint.