Finish Testing 2D bundle adjustment using Quasi Newton Method  to Optimize the least square problem