Added gtest for 3D Homegeneous Transformations