fixed compilation errors under ROS indigo