Adding upright bundle adjustment functions
Changed ExtractImagesCatadioptric to use the unmodified pose as output
Changed AddImages to match new Bundle constructor