fixes binary heap issues and adds tests
Improves unit tests
Merge pull request #4 from markableidinger/working

Stack update
Merge pull request #3 from markableidinger/master

Master