Fix Arma implementation to only fill upper triangular part of Hamiltonian