Browse Source

servo_endstops -> servo_endstop_id

Scott Lahteine 10 years ago
parent
commit
1f63293624
2 changed files with 11 additions and 11 deletions
  1. 1
    1
      Marlin/Conditionals.h
  2. 10
    10
      Marlin/Marlin_main.cpp

+ 1
- 1
Marlin/Conditionals.h View File

513
 
513
 
514
   #define HAS_BUZZER ((defined(BEEPER) && BEEPER >= 0) || defined(LCD_USE_I2C_BUZZER))
514
   #define HAS_BUZZER ((defined(BEEPER) && BEEPER >= 0) || defined(LCD_USE_I2C_BUZZER))
515
 
515
 
516
-
517
   #if defined( NUM_SERVOS ) && (NUM_SERVOS > 0)
516
   #if defined( NUM_SERVOS ) && (NUM_SERVOS > 0)
518
     #ifndef X_ENDSTOP_SERVO_NR
517
     #ifndef X_ENDSTOP_SERVO_NR
519
       #define X_ENDSTOP_SERVO_NR -1
518
       #define X_ENDSTOP_SERVO_NR -1
527
     #if (X_ENDSTOP_SERVO_NR >= 0) || (Y_ENDSTOP_SERVO_NR >= 0) || (Z_ENDSTOP_SERVO_NR >= 0)
526
     #if (X_ENDSTOP_SERVO_NR >= 0) || (Y_ENDSTOP_SERVO_NR >= 0) || (Z_ENDSTOP_SERVO_NR >= 0)
528
       #define SERVO_ENDSTOPS {X_ENDSTOP_SERVO_NR, Y_ENDSTOP_SERVO_NR, Z_ENDSTOP_SERVO_NR}
527
       #define SERVO_ENDSTOPS {X_ENDSTOP_SERVO_NR, Y_ENDSTOP_SERVO_NR, Z_ENDSTOP_SERVO_NR}
529
       #define HAS_SERVO_ENDSTOPS true
528
       #define HAS_SERVO_ENDSTOPS true
529
+      #define SERVO_ENDSTOP_IDS { X_ENDSTOP_SERVO_NR, Y_ENDSTOP_SERVO_NR, Z_ENDSTOP_SERVO_NR }
530
     #endif
530
     #endif
531
   #endif
531
   #endif
532
 
532
 

+ 10
- 10
Marlin/Marlin_main.cpp View File

314
   };
314
   };
315
 #endif
315
 #endif
316
 
316
 
317
-  const int servo_endstops[] = SERVO_ENDSTOPS;
318
 #if HAS_SERVO_ENDSTOPS
317
 #if HAS_SERVO_ENDSTOPS
318
+  const int servo_endstop_id[] = SERVO_ENDSTOP_IDS;
319
   const int servo_endstop_angles[][2] = SERVO_ENDSTOP_ANGLES;
319
   const int servo_endstop_angles[][2] = SERVO_ENDSTOP_ANGLES;
320
 #endif
320
 #endif
321
 
321
 
580
   // Set position of Servo Endstops that are defined
580
   // Set position of Servo Endstops that are defined
581
   #if HAS_SERVO_ENDSTOPS
581
   #if HAS_SERVO_ENDSTOPS
582
     for (int i = 0; i < 3; i++)
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
   #endif
585
   #endif
586
 
586
 
587
 }
587
 }
1325
     #if HAS_SERVO_ENDSTOPS
1325
     #if HAS_SERVO_ENDSTOPS
1326
 
1326
 
1327
       // Engage Z Servo endstop if enabled
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
     #elif defined(Z_PROBE_ALLEN_KEY)
1330
     #elif defined(Z_PROBE_ALLEN_KEY)
1331
       feedrate = Z_PROBE_ALLEN_KEY_DEPLOY_1_FEEDRATE;
1331
       feedrate = Z_PROBE_ALLEN_KEY_DEPLOY_1_FEEDRATE;
1415
     #if HAS_SERVO_ENDSTOPS
1415
     #if HAS_SERVO_ENDSTOPS
1416
 
1416
 
1417
       // Retract Z Servo endstop if enabled
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
         #if Z_RAISE_AFTER_PROBING > 0
1420
         #if Z_RAISE_AFTER_PROBING > 0
1421
           if (doRaise) {
1421
           if (doRaise) {
1425
         #endif
1425
         #endif
1426
 
1426
 
1427
         // Change the Z servo angle
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
     #elif defined(Z_PROBE_ALLEN_KEY)
1431
     #elif defined(Z_PROBE_ALLEN_KEY)
1678
 
1678
 
1679
     #if HAS_SERVO_ENDSTOPS
1679
     #if HAS_SERVO_ENDSTOPS
1680
       // Engage Servo endstop if enabled
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
     #endif
1683
     #endif
1684
 
1684
 
1685
     // Set a flag for Z motor locking
1685
     // Set a flag for Z motor locking
1780
     {
1780
     {
1781
       #if HAS_SERVO_ENDSTOPS
1781
       #if HAS_SERVO_ENDSTOPS
1782
         // Retract Servo endstop if enabled
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
       #endif
1785
       #endif
1786
     }
1786
     }
1787
 
1787
 

Loading…
Cancel
Save