Надо в режиме MDI и в режиме AUTO запускать смену инструмента и наблюдать за формированием сигнала G54.1
определить почему в режиме AUTO этот сигнал ложно формируется
Чисто технически тут нет никакой проблемы: привод давит с заданным процентом момента. Опционально можно контролировать перемещение и и при превышении какого-то значения выдавать ошибку.