Юниты постоянно тупят и идут не туда

Ну пути на больших расстояниях просчитываются плохо в целях оптимизации. Особенно когда приказ идет на большое кол-во юнитов. Стандартными способами не исправить, кроме как написать свою систему перемещания юнитов и поиска путей, но это очень страшная вещь :D
В зависимости от жанра карты и что ты хочешь, к примеру если юниты под контролем не игрока, то приказы и правда можно оптимизировать, перенаправляя их по очереди по пунктам из региона A в регион B, из региона B в регион C и тд до конечной цели. На небольших расстояниях они нормально просчитывают пути.

Если прям так важно и в этом вся суть карты, то придется делать MUI-шную систему отрядов: разместить области по пути следования, триггеры на попадания в эти области, каждую группу юнитов записывать в массив отрядов при создании, записывать в массив и точку приказа этого отряда. При попадании в область обнаруживать перебором индекс отряда, юниты которого туда зашли. Менять этому отряду приказ на следование в следующую область и т.д. до конца. При смерти юнитов проверять, мертвы ли все юниты в отрядах, и если да, то очищать все отряды, точки и массивы, запуская процесс заново.

По крайней мере, я так делал. В таких ситуациях нельзя полагаться на авось, всё надо контролировать от и до.