Дельта NEUTRON по высоте примерно в 2 раза врет

Всем привет! Собрал дельту NEUTRON https://www.thingiverse.com/thing:2149660/#comments. Но теперь проблема, вроде настроил, но по высоте врет. Паркую в положение HOME, потом пытаюсь выполнить калибровку стола, он проходит ровно половину и выдает ошибку. Если я подложу на стол коробку что бы по высоте подходило, то калибровка стола проходит нормально. Еще если подключаю к компу, то через репитер тоже при отправке проехать 10 мм, принтер опускается на 5мм. В прошивке пытался менять настройки в шагах двигателя, но результата ни какого, вообще ни чего не меняется.

Это первоначальный код:

#define NEMA17_FULL_STEPS 200.0

#define NEMA17_MICROSTEPS 16.0

#define NEMA17_MOTOR_STEPS (NEMA17_FULL_STEPS * NEMA17_MICROSTEPS)

#define XYZ_ROD_PITCH 14

#define DEFAULT_XYZ_STEPS_PER_UNIT (NEMA17_MOTOR_STEPS / XYZ_ROD_PITCH)

#define HOBBED_BOLT_DIAM 10.56

#define HOBBED_BOLD_CIRC (M_PI * HOBBED_BOLT_DIAM)

#define E_STEPS (NEMA17_MOTOR_STEPS / HOBBED_BOLD_CIRC)

#define DEFAULT_AXIS_STEPS_PER_UNIT { DEFAULT_XYZ_STEPS_PER_UNIT, DEFAULT_XYZ_STEPS_PER_UNIT, DEFAULT_XYZ_STEPS_PER_UNIT, E_STEPS}

По идее мой случай это 'Трапецеидальный винт диаметром 8 мм с шагом 2 мм и заходностью 4, тогда формула: 200*16/2*4=400', менял формулы в последней строке, ставил 400, но нет ни какого результата, так же только половина по высоте

Моя прошивка https://cloud.mail.ru/public/M94V/Mv8YaGJCW

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

Прошу помочь, заранее спасибо!