Update fib heap, fix and add test for not visiting all nodes

Related #39