Added the code for ROS

Ok, voilà la version ros du code si tu veux =).