Update to Catkin package , tested on Hydro