Fix bug in ROS code.