Units should follow navigationplans
Pathfinding now works.