Add catkin_pkg