Made QP solver in CP more robust