Added catkin package definition and compiled on trusty