bissen21/Marlin_Firmware
1
0
Fork 0
Code Issues Pull Requests Projects Releases 4 Wiki Activity

Make SERVO_ENDSTOP_ANGLES 2-dimensional

Browse Source
This commit is contained in:
Scott Lahteine
2015-07-28 19:22:44 -07:00
committed by Richard Wackerbarth
parent 525d0dc239
commit 0af2a80e06
18 changed files with 22 additions and 22 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
Marlin/Marlin_main.cpp
View File

@ -316,7 +316,7 @@ bool target_direction;
#ifdef SERVO_ENDSTOPS
const int servo_endstops[] = SERVO_ENDSTOPS;
const int servo_endstop_angles[] = SERVO_ENDSTOP_ANGLES;
const int servo_endstop_angles[][] = SERVO_ENDSTOP_ANGLES;
#endif
#ifdef BARICUDA
@ -581,7 +581,7 @@ void servo_init() {
#ifdef SERVO_ENDSTOPS
for (int i = 0; i < 3; i++)
if (servo_endstops[i] >= 0)
servo[servo_endstops[i]].move(servo_endstop_angles[i * 2 + 1]);
servo[servo_endstops[i]].move(servo_endstop_angles[i][1]);
#endif
}
@ -1325,7 +1325,7 @@ static void setup_for_endstop_move() {
#ifdef SERVO_ENDSTOPS
// Engage Z Servo endstop if enabled
if (servo_endstops[Z_AXIS] >= 0) servo[servo_endstops[Z_AXIS]].move(servo_endstop_angles[Z_AXIS * 2]);
if (servo_endstops[Z_AXIS] >= 0) servo[servo_endstops[Z_AXIS]].move(servo_endstop_angles[Z_AXIS][0]);
#elif defined(Z_PROBE_ALLEN_KEY)
feedrate = Z_PROBE_ALLEN_KEY_DEPLOY_1_FEEDRATE;
@ -1425,7 +1425,7 @@ static void setup_for_endstop_move() {
#endif
// Change the Z servo angle
servo[servo_endstops[Z_AXIS]].move(servo_endstop_angles[Z_AXIS * 2 + 1]);
servo[servo_endstops[Z_AXIS]].move(servo_endstop_angles[Z_AXIS][1]);
}
#elif defined(Z_PROBE_ALLEN_KEY)
@ -1783,7 +1783,7 @@ static void homeaxis(AxisEnum axis) {
#ifdef SERVO_ENDSTOPS
// Retract Servo endstop if enabled
if (servo_endstops[axis] >= 0)
servo[servo_endstops[axis]].move(servo_endstop_angles[axis * 2 + 1]);
servo[servo_endstops[axis]].move(servo_endstop_angles[axis][1]);
#endif
}