Added simple heap implementation