Fix gtsam package not found in catkin.

This is wrong! It was fixed when Mathias changed it to GTSAM