Fix catkin package