Pushing the Envelope of Modern Methods for Bundle Adjustment
matrix computations ( 3 . ed . ) .