fix catkin gtest and rostest problem