Working on setupP, HFmatrix and calc_energy in HFSolveY