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.