Basic Pathfinding

First version of working pathfinding. It uses only BFS, so it finds the
way with least crossroads in between, but is useful for developing rest
of the stuff.