Tests made with ros gtest