Fix QuadraticProgram, now it overloads the methods from NonlinearProgram, such as addCost