Pathfinding code. Currently works standalone but shouldn't be too hard to get it to work with the rest of the code base.