Made changes to enable gtest and ROS_DEBUG.