Added all ROS-relevant code