Are you using a waypoint, or move to position?
From what I remember waypoint acts more like bumpercars, and position uses pathfinding.
Its actually kind of useful to use waypoint when you have a ton of objects.... pathfinding really slows it down.
What you can do is have one unit as the pathfinder, then add a condition for the rest like distance(.pathfinder, .unit) > n add waypoint at .pathfinder... .unit that is