Added the code for ROS
Merge pull request #1 from MalcolmMielle/master

Added the code for ROS