Skip to main content

Module pose_graph_optimization_3d

Module pose_graph_optimization_3d 

Source
Expand description

SE(3) pose-graph optimization on the shared factor-graph backend.

Structs§

Edge3D
A relative SE(3) constraint between two pose nodes.
Pose3DNode
A 3D pose represented by a homogeneous SE(3) matrix.
PoseGraphResult3D
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.