Add diagonal preconditioner to in-house CG code