Incorporated fixes to robust qp solve