ROS initial Implementation