Tweaks for convergence
Adding cg.h, actual linear solver to do quadraticMin