Second best path attempt (I will probably continue tomorrow)

the A* algorithm is NOT completely implemented, nevertheless the best
path part works