Port unsupported constrained CG to Eigen3