Fix gtsam package not found in catkin.