use ROS_DEBUG instead of std::cout or remove this line