Basic pathfinding works now.