Function Sophus::toPose2D

• Defined in File helpers.hpp

Function Documentation

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

Convert a full Sophus pose into a 2 dimensional pose.

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