|
|
@ -687,8 +687,10 @@ static void homeaxis(int axis) {
|
|
|
|
0) {
|
|
|
|
0) {
|
|
|
|
|
|
|
|
|
|
|
|
// Engage Servo endstop if enabled
|
|
|
|
// Engage Servo endstop if enabled
|
|
|
|
#ifdef SERVO_ENDSTOPS[axis] > -1
|
|
|
|
#ifdef SERVO_ENDSTOPS
|
|
|
|
servos[servo_endstops[axis]].write(servo_endstop_angles[axis * 2]);
|
|
|
|
if (SERVO_ENDSTOPS[axis] > -1) {
|
|
|
|
|
|
|
|
servos[servo_endstops[axis]].write(servo_endstop_angles[axis * 2]);
|
|
|
|
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
current_position[axis] = 0;
|
|
|
|
current_position[axis] = 0;
|
|
|
@ -715,8 +717,10 @@ static void homeaxis(int axis) {
|
|
|
|
endstops_hit_on_purpose();
|
|
|
|
endstops_hit_on_purpose();
|
|
|
|
|
|
|
|
|
|
|
|
// Retract Servo endstop if enabled
|
|
|
|
// Retract Servo endstop if enabled
|
|
|
|
#ifdef SERVO_ENDSTOPS[axis] > -1
|
|
|
|
#ifdef SERVO_ENDSTOPS
|
|
|
|
servos[servo_endstops[axis]].write(servo_endstop_angles[axis * 2 + 1]);
|
|
|
|
if (SERVO_ENDSTOPS[axis] > -1) {
|
|
|
|
|
|
|
|
servos[servo_endstops[axis]].write(servo_endstop_angles[axis * 2 + 1]);
|
|
|
|
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|