pub fn optimize_pose_graph_3d(
initial_poses: &[Pose3DNode],
edges: &[Edge3D],
config: &PoseGraphConfig,
) -> PoseGraphResult3DExpand description
Optimizes an SE(3) pose graph, fixing the first pose as the gauge anchor.
pub fn optimize_pose_graph_3d(
initial_poses: &[Pose3DNode],
edges: &[Edge3D],
config: &PoseGraphConfig,
) -> PoseGraphResult3DOptimizes an SE(3) pose graph, fixing the first pose as the gauge anchor.