bundle adjustment almost finished