added code for just sqp based fitting assuming that correspondences are given