Added remove (min) and decrease key functions to heap, as well as updating of the state heap index