Added initial ROS wrapper nodes