pub fn optimize_pose_graph(
initial_poses: &[Pose2DNode],
edges: &[Edge2D],
config: &PoseGraphConfig,
) -> PoseGraphResultExpand description
Optimizes a 2D pose graph using the workspace nonlinear least-squares backend. The first pose is fixed to remove gauge freedom.