|
@@ -314,8 +314,8 @@ bool target_direction;
|
314
|
314
|
};
|
315
|
315
|
#endif
|
316
|
316
|
|
317
|
|
- const int servo_endstops[] = SERVO_ENDSTOPS;
|
318
|
317
|
#if HAS_SERVO_ENDSTOPS
|
|
318
|
+ const int servo_endstop_id[] = SERVO_ENDSTOP_IDS;
|
319
|
319
|
const int servo_endstop_angles[][2] = SERVO_ENDSTOP_ANGLES;
|
320
|
320
|
#endif
|
321
|
321
|
|
|
@@ -580,8 +580,8 @@ void servo_init() {
|
580
|
580
|
// Set position of Servo Endstops that are defined
|
581
|
581
|
#if HAS_SERVO_ENDSTOPS
|
582
|
582
|
for (int i = 0; i < 3; i++)
|
583
|
|
- if (servo_endstops[i] >= 0)
|
584
|
|
- servo[servo_endstops[i]].move(servo_endstop_angles[i][1]);
|
|
583
|
+ if (servo_endstop_id[i] >= 0)
|
|
584
|
+ servo[servo_endstop_id[i]].move(servo_endstop_angles[i][1]);
|
585
|
585
|
#endif
|
586
|
586
|
|
587
|
587
|
}
|
|
@@ -1325,7 +1325,7 @@ static void setup_for_endstop_move() {
|
1325
|
1325
|
#if HAS_SERVO_ENDSTOPS
|
1326
|
1326
|
|
1327
|
1327
|
// Engage Z Servo endstop if enabled
|
1328
|
|
- if (servo_endstops[Z_AXIS] >= 0) servo[servo_endstops[Z_AXIS]].move(servo_endstop_angles[Z_AXIS][0]);
|
|
1328
|
+ if (servo_endstop_id[Z_AXIS] >= 0) servo[servo_endstop_id[Z_AXIS]].move(servo_endstop_angles[Z_AXIS][0]);
|
1329
|
1329
|
|
1330
|
1330
|
#elif defined(Z_PROBE_ALLEN_KEY)
|
1331
|
1331
|
feedrate = Z_PROBE_ALLEN_KEY_DEPLOY_1_FEEDRATE;
|
|
@@ -1415,7 +1415,7 @@ static void setup_for_endstop_move() {
|
1415
|
1415
|
#if HAS_SERVO_ENDSTOPS
|
1416
|
1416
|
|
1417
|
1417
|
// Retract Z Servo endstop if enabled
|
1418
|
|
- if (servo_endstops[Z_AXIS] >= 0) {
|
|
1418
|
+ if (servo_endstop_id[Z_AXIS] >= 0) {
|
1419
|
1419
|
|
1420
|
1420
|
#if Z_RAISE_AFTER_PROBING > 0
|
1421
|
1421
|
if (doRaise) {
|
|
@@ -1425,7 +1425,7 @@ static void setup_for_endstop_move() {
|
1425
|
1425
|
#endif
|
1426
|
1426
|
|
1427
|
1427
|
// Change the Z servo angle
|
1428
|
|
- servo[servo_endstops[Z_AXIS]].move(servo_endstop_angles[Z_AXIS][1]);
|
|
1428
|
+ servo[servo_endstop_id[Z_AXIS]].move(servo_endstop_angles[Z_AXIS][1]);
|
1429
|
1429
|
}
|
1430
|
1430
|
|
1431
|
1431
|
#elif defined(Z_PROBE_ALLEN_KEY)
|
|
@@ -1678,8 +1678,8 @@ static void homeaxis(AxisEnum axis) {
|
1678
|
1678
|
|
1679
|
1679
|
#if HAS_SERVO_ENDSTOPS
|
1680
|
1680
|
// Engage Servo endstop if enabled
|
1681
|
|
- if (axis != Z_AXIS && servo_endstops[axis] >= 0)
|
1682
|
|
- servo[servo_endstops[axis]].move(servo_endstop_angles[axis][0]);
|
|
1681
|
+ if (axis != Z_AXIS && servo_endstop_id[axis] >= 0)
|
|
1682
|
+ servo[servo_endstop_id[axis]].move(servo_endstop_angles[axis][0]);
|
1683
|
1683
|
#endif
|
1684
|
1684
|
|
1685
|
1685
|
// Set a flag for Z motor locking
|
|
@@ -1780,8 +1780,8 @@ static void homeaxis(AxisEnum axis) {
|
1780
|
1780
|
{
|
1781
|
1781
|
#if HAS_SERVO_ENDSTOPS
|
1782
|
1782
|
// Retract Servo endstop if enabled
|
1783
|
|
- if (servo_endstops[axis] >= 0)
|
1784
|
|
- servo[servo_endstops[axis]].move(servo_endstop_angles[axis][1]);
|
|
1783
|
+ if (servo_endstop_id[axis] >= 0)
|
|
1784
|
+ servo[servo_endstop_id[axis]].move(servo_endstop_angles[axis][1]);
|
1785
|
1785
|
#endif
|
1786
|
1786
|
}
|
1787
|
1787
|
|