Skip to main content

Module pose_graph_optimization

Module pose_graph_optimization 

Source
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:

Structs§

Edge2D
A relative pose constraint between two nodes.
Pose2DNode
A 2D pose node.
PoseGraphConfig
Configuration for pose graph optimization.
PoseGraphResult
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 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.