Added KKT tolerance calc to the qpDUNES based OCP solvers