Problem with Z-probe and autoleveling (5 replies)

Hello everyone :)

My name is Artur, i'm from Poland.
I have problem with latest Repetier-Firmware and z-probe/autoleveling feature.

First, I moved Z_MIN to Z_MAX:

pins.h

#define Z_MIN_PIN          -1  //27
#define Z_MAX_PIN          27  //-1

configuration.h

#define MIN_HARDWARE_ENDSTOP_Z false
...
#define ENDSTOP_PULLUP_Z_MAX true
#define ENDSTOP_Z_MAX_INVERTING true
#define MAX_HARDWARE_ENDSTOP_Z true
...
#define min_software_endstop_z true
...
#define max_software_endstop_z false
...
#define Z_HOME_DIR 1  //-1

After this printer is homing in X=0, Y=0, Z=170 without any problems and I can print as earlier.

Second, I configured servo:

#define FEATURE_SERVO 1
#define SERVO0_PIN 15

I tested it with M340, it works great.

Third, I configured z-probe:

#define FEATURE_Z_PROBE 1
#define Z_PROBE_PIN 40
#define Z_PROBE_PULLUP 1
#define Z_PROBE_ON_HIGH 0
#define Z_PROBE_X_OFFSET 50
#define Z_PROBE_Y_OFFSET 30
#define Z_PROBE_WAIT_BEFORE_TEST 0
#define Z_PROBE_SPEED 2
#define Z_PROBE_XY_SPEED 500
#define Z_PROBE_HEIGHT 3.3
#define Z_PROBE_START_SCRIPT "M340 P0 S1450"
#define Z_PROBE_FINISHED_SCRIPT "M340 P0 S600"
#define FEATURE_AUTOLEVEL 1
#define Z_PROBE_X1 55
#define Z_PROBE_Y1 35
#define Z_PROBE_X2 130
#define Z_PROBE_Y2 200
#define Z_PROBE_X3 200
#define Z_PROBE_Y3 35

This is separated switch connected to PIN 40 on my board.
I tested it with G31, I get "L" when it is not pressed, and "H" when I press the switch with finger.

When I send G29 S2 to the printer (just after homing):
- servo moves to correct position (so Z_PROBE_START_SCRIPT is OK)
- extruder moves to X=55, Y=35,
- then moves to X=5, Y=5 (I guess it is Z_PROBE_X1 - Z_PROBE_X_OFFSET and Z_PROBE_Y1 - Z_PROBE_Y_OFFSET, so it should be OK)
- and than I immediatelly get "Error: Z-probe failed".
Z axis is not move at all, but on LCD Z switches from 170 to 0.

My board is teensylu based "UniqueOne" with AT90USB1287 CPU. All other features (LCD, SD, fan etc.) work great.
My full configuration.h is attached.

Do you have any ideas what might be a reason of this error?

Greetings

Artur