For greater generality, eval function in ContactWrenchConstraint also takes kinsol as input argument. This would not hurt the efficiency in optimization since we have the evalSparsity function, which would return a sparse pattern if eval does not depend on kinsol