Move common algorithm code to abstract classes

[pablormier]

Algorithms like Dijkstra, A* etc share lots of lines in common. Create abstract classes to extend basic behaviour and reuse same data structures and components.