Issue #432 fix

Implementing Dijkstra algorithm using binary heap. Required test has
been added.