Template Function lvr2::matrixToPose

• Defined in File TransformUtils.hpp

Function Documentation

template<typename T>
void lvr2::matrixToPose(const Transform<T> &mat, Vector3<T> &position, Vector3<T> &rotation)

Extracts the Pose from a Matrix.

Parameters:

• pose – A Matrix representing a Pose

• position – Output for the position of the Pose

• rotation – Output for the rotation in radians