Function Sophus::toPose3D

• Defined in File helpers.hpp

Function Documentation

Sophus::SE3f Sophus::toPose3D(const Eigen::Vector3f &pose)

Convert a 2 dimensional pose to a full Sophus pose in 3d.

The 2d pose is a typical mobile robot 2d pose with (x, y, heading) with heading measured in radians.