This converts an transform given in an homogeneous matrix to a pose vector in (t, utheta) representation. Eigen lacks a lot of functions useful for robotics. I would start with this one, the moore-penrose pseudoinverse, and twist transformation matrices, but for sure there are more that would be nice to have.