Initial checkin of Solve_Ahat_p_fhat_CG_PETSc