Unstable pathfinding implementation.

The implementation is still not ready for use.