Added functionality to ExtractImagesCatadioptric to take in prior pose (coming from EstimateVertical)