Started on actual pathfinding.

This is a gonna get hairy.