catkin provides gtest, no need for find_package
Merge pull request #252 from ros-planning/fix_gtest

catkin provides gtest, no need for find_package