Merge pull request #5 from nkibler7/master

Fixed errors.
Final changes and beautification
Changed MinHeap to make it more efficient.