Changed return value for getRootTransform and setRootTransform to a fixed size Eigen Matrix