Fix heap insert