Hamiltonian construction checked. Happy with this version.
Construction of overlap matrix optimized.