3D Reconstruction of Complex Structures with Bundle Adjustment: an Incremental Approach