Don't add the start node twice in djikstra's
Minor refactoring
Fixed fib heap djikstra's

Fixes #39