И снова автоуровень Repetier firmware

Плата - RAMPS-FD. Головка с тензодатчиком, который реагирует непосредственно на прикосновение к столу.

Проблема, в общем-то простая: после автолевела печать идет по воздуху.

Стартовый код такой:

M107

M190 S90 ; set bed temperature

M104 S250 ; set temperature

G28 ; home all axes

G1 Z5 F5000 ; lift nozzle

G32

Сопло нужно поднимать между парковкой и автолевелом, потому что при движении в моем случае сопло задевает за стол, датчик срабатывает, и прошивка валится с ошибкой: срабатывание концевика до замера, или что-то в этом духе. Причина, может быть, и в этом, но как решить ее по-другому не знаю. Может быть, подскажете?

Если же производить операции, как делю сейчас я, то после замеров мозгам кажется (М114), что высота головки около 1 мм, хотя на вид не меньше 2-х.

Помогите разобраться, что может быть не так.

Настройки такие:

// #################### Z-Probing #####################

#define Z_PROBE_Z_OFFSET 0

#define Z_PROBE_Z_OFFSET_MODE 0

#define UI_BED_COATING 1

#define FEATURE_Z_PROBE 1

#define Z_PROBE_BED_DISTANCE 5

#define Z_PROBE_PIN ORIG_Z_MIN_PIN

#define Z_PROBE_PULLUP 0

#define Z_PROBE_ON_HIGH 1

#define Z_PROBE_X_OFFSET 0

#define Z_PROBE_Y_OFFSET 0

#define Z_PROBE_WAIT_BEFORE_TEST 0

#define Z_PROBE_SPEED 2

#define Z_PROBE_XY_SPEED 100

#define Z_PROBE_SWITCHING_DISTANCE 0.1

#define Z_PROBE_REPETITIONS 1

#define Z_PROBE_HEIGHT 0

#define Z_PROBE_START_SCRIPT ''

#define Z_PROBE_FINISHED_SCRIPT ''

#define Z_PROBE_REQUIRES_HEATING 0

#define Z_PROBE_MIN_TEMPERATURE 150

#define FEATURE_AUTOLEVEL 1

#define Z_PROBE_X1 20

#define Z_PROBE_Y1 20

#define Z_PROBE_X2 160

#define Z_PROBE_Y2 20

#define Z_PROBE_X3 20

#define Z_PROBE_Y3 160

#define BED_LEVELING_METHOD 1

#define BED_CORRECTION_METHOD 0

#define BED_LEVELING_GRID_SIZE 2

#define BED_LEVELING_REPETITIONS 5

#define BED_MOTOR_1_X 0

#define BED_MOTOR_1_Y 0

#define BED_MOTOR_2_X 200

#define BED_MOTOR_2_Y 0

#define BED_MOTOR_3_X 100

#define BED_MOTOR_3_Y 200

#define BENDING_CORRECTION_A 0

#define BENDING_CORRECTION_B 0

#define BENDING_CORRECTION_C 0

#define FEATURE_AXISCOMP 0

#define AXISCOMP_TANXY 0

#define AXISCOMP_TANYZ 0

#define AXISCOMP_TANXZ 0