tools for rotations and homogeneous transforms (Special Orthogonal group and Special Euclidean group)