Update data structure in rigid GlobalSfM