Skip to main content

optimize_pose_graph_warm

Function optimize_pose_graph_warm 

Source
pub fn optimize_pose_graph_warm(
    initial_poses: &[Pose2DNode],
    edges: &[Edge2D],
    config: &PoseGraphConfig,
    initial_damping: f64,
) -> (PoseGraphResult, f64)
Expand description

Like optimize_pose_graph, but starts Levenberg-Marquardt from initial_damping and also returns the damping it ended with, so a solve spread over several short calls (a few iterations per frame) continues where the last call stopped instead of restarting its damping.