Modified Bundle Adjustment_still work in progress after CVPRTUM