Implemented new first pose calculation with non-linear regression which is more robust