Starting pathfinding/testing that I can commit.