Проблему решили. Вообщем перепробывали все методы на форуме, а оказалось все проще, на драйверах были выставлены неправильно токи, на двигатель 0,6А был подан ток 1,5А из за чего он сильно перегревался и при движении был скрежет страшный. Диагностировали просто приложив руку к двигателю по Х, который оказался очень горячим.
Понизили токи и в итоге пропал скрежет и смещение исчезло.
Решение подглядели на форуме)