Implement CG
Refactor the CG routine
Implement zeros()
Use the new CG routine