Implemented Dijkstra/A* based pathfinder
Merge branch 'master' of https://github.com/Wieke/bee-formation