Added ros package implementation