Да, в ini поставь DEADBAND = не 0.0, а как минимум величина шага ШД, или минимальной ошибке...
DEADBAND - это мертвая зона в которой станок успокоится и не будет пытаться доехать дальше, иначе он может начать скакать +-несколько шагов вокруг нужной точки.
