Integrate pathfinding to dev.

Closes #53.