Converted to run as a ROS node.
Added ROS code.