Added more functionality as a ROS node.
More services and a library.