Skip to main content

optimize_pose_graph_3d

Function optimize_pose_graph_3d 

Source
pub fn optimize_pose_graph_3d(
    initial_poses: &[Pose3DNode],
    edges: &[Edge3D],
    config: &PoseGraphConfig,
) -> PoseGraphResult3D
Expand description

Optimizes an SE(3) pose graph, fixing the first pose as the gauge anchor.