Update Findgtsam.cmake