Template Function lvr2::getPoseFromMatrix

Function Documentation

template<typename T>
void lvr2::getPoseFromMatrix(BaseVector<T> &position, BaseVector<T> &angles, const Transform<T> &mat)

Computes a Euler representation from the given transformation matrix.

Parameters:
  • position – Will contain the position

  • angles – Will contain the rotation angles in radians

  • mat – The transformation matrix