Fix catkin build