Making it ROS ready