Странный начальный код. Зачем там перевод координат в миллиметры, и, если он уж нужен, то почему он после совершения некоторых движений, а не перед всем? То же самое по поводу включения абсолютных координат и относительных координат экструдера, почему они не перед всем, а в середине?