Added heap insertion algorithm.