Expand description
SE(3) pose-graph optimization on the shared factor-graph backend.
Structs§
- Edge3D
- A relative SE(3) constraint between two pose nodes.
- Pose3D
Node - A 3D pose represented by a homogeneous SE(3) matrix.
- Pose
Graph Result3D - Result of an SE(3) pose-graph solve.
Functions§
- optimize_
pose_ graph_ 3d - Optimizes an SE(3) pose graph, fixing the first pose as the gauge anchor.