Eigen-based C++ QP solver.

Travis CI: https://travis-ci.org/asherikov/qpmad Build Status

Eigen-based, header-only C++ implementation of Goldfarb-Idnani dual active set algorithm for quadratic programming. The intended purpose of this solver is embedded optimization for robot control, for this reason some of the computations are omitted as described below. The package is ROS compatible.




  • Double sided inequality constraints: lb <= A*x <= ub. Such constraints can be handled in a more efficient way than lb <= A*x commonly used in other implementations of the algorithm.
  • Simple bounds: lb <= x <= ub.
  • Lazy data initialization, e.g., perform inversion of the Cholesky factor only if some of the constraints are activated.
  • Does not compute value of the objective function.
  • Does not compute/update Lagrange multipliers for equality constraints.


  • cmake
  • Eigen
  • Boost (for C++ tests)


  1. Before computing the full step length I check that the dot product of the chosen constraint with the step direction is not zero instead of checking the norm of the step direction. The former approach makes more sense since the said dot product appears later as a divisor and we can avoid computation of a useless norm.
  2. I am aware that activation of simple bounds zeroes out parts of matrix 'J'. Unfortunately, I don't see a way to exploit this on modern hardware – updating the whole 'J' at once is computationally cheaper than doing this line by line selectively or permuting 'J' to collect sparse rows in one place.
  3. Since the solver may arbitrarily choose violated constraints for activation, it always prefers the cheapest ones, i.e., the simple bounds. In particular, this allows to avoid computation of violations of general constraints if there are violated bounds.
  4. Vector 'd' and primal step direction are updated during partial steps instead of being computed from scratch. This, however, does not result in a significant performance improvement.

Documentation and examples