Working on A* Pathfinding.  Needs testing.