Reverted back to Eigen library. The tf library has different ways of dealing with transformations and every test using the tf library failed.
Started creating yaml files