Bundle Adjustment for Matlab