Add bundle adjustment step