Implement CG and analytic inversion for additional constraints case

[corettialessandro]

Single additional constraint already implemented for the analytic inversion. Double additional constraint is necessary.
For the conjugate gradient minimization technique both cases are missing.