Expand description
2D pose graph optimization with Gauss-Newton iteration.
The optimizer refines a set of initial poses from relative pose constraints represented as edges in an SE(2) graph.
Reference:
- Giorgio Grisetti, Rainer Kümmerle, Cyrill Stachniss, Wolfram Burgard, “A Tutorial on Graph-Based SLAM”: https://www.ipb.uni-bonn.de/wp-content/papercite-data/pdf/grisetti10titsmag.pdf
Structs§
- Edge2D
- A relative pose constraint between two nodes.
- Pose2D
Node - A 2D pose node.
- Pose
Graph Config - Configuration for pose graph optimization.
- Pose
Graph Result - Optimization result.
Functions§
- optimize_
pose_ graph - Optimizes a 2D pose graph using the workspace nonlinear least-squares backend. The first pose is fixed to remove gauge freedom.
- optimize_
pose_ graph_ warm - Like
optimize_pose_graph, but starts Levenberg-Marquardt frominitial_dampingand 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.