Added sort to restore heap property
Sort openList when a opened node F-cost is changed (Thanks @amitp)