homing
This commit is contained in:
+12
-12
@@ -274,12 +274,12 @@ void loop() {
|
||||
|
||||
if (homingState == HOME_ALL_PHASE1) {
|
||||
if (stepper1.distanceToGo() == 0 && stepper2.distanceToGo() == 0) {
|
||||
stepper1.setCurrentPosition(474);
|
||||
stepper2.setCurrentPosition(530);
|
||||
stepper1.setCurrentPosition(1024);
|
||||
stepper2.setCurrentPosition(0);
|
||||
stepper1.moveTo(1024);
|
||||
stepper2.moveTo(0);
|
||||
homingState = HOME_ALL_PHASE2;
|
||||
Serial.println("[SYS] Homing all: Phase 2 (Move to Outward Home)");
|
||||
Serial.println("[SYS] Homing all: Phase 2 (Hold Outward Home)");
|
||||
}
|
||||
} else if (homingState == HOME_ALL_PHASE2) {
|
||||
if (stepper1.distanceToGo() == 0 && stepper2.distanceToGo() == 0) {
|
||||
@@ -295,7 +295,7 @@ void loop() {
|
||||
}
|
||||
} else if (homingState == HOME_1_PHASE1) {
|
||||
if (stepper1.distanceToGo() == 0) {
|
||||
stepper1.setCurrentPosition(474);
|
||||
stepper1.setCurrentPosition(1024);
|
||||
stepper1.moveTo(1024);
|
||||
homingState = HOME_1_PHASE2;
|
||||
}
|
||||
@@ -308,7 +308,7 @@ void loop() {
|
||||
}
|
||||
} else if (homingState == HOME_2_PHASE1) {
|
||||
if (stepper2.distanceToGo() == 0) {
|
||||
stepper2.setCurrentPosition(530);
|
||||
stepper2.setCurrentPosition(0);
|
||||
stepper2.moveTo(0);
|
||||
homingState = HOME_2_PHASE2;
|
||||
}
|
||||
@@ -335,28 +335,28 @@ void loop() {
|
||||
// ─── Homing Routines ──────────────────────────────────────────────
|
||||
|
||||
void performHomingAll() {
|
||||
Serial.println("[SYS] Homing all: Phase 1 (Stall UP)");
|
||||
Serial.println("[SYS] Homing all: Phase 1 (Stall OUTWARD)");
|
||||
stepper1.setMaxSpeed(1500);
|
||||
stepper2.setMaxSpeed(1500);
|
||||
stepper1.setAcceleration(1500);
|
||||
stepper2.setAcceleration(1500);
|
||||
stepper1.move(-1200);
|
||||
stepper2.move(1200);
|
||||
stepper1.move(2000);
|
||||
stepper2.move(-2000);
|
||||
homingState = HOME_ALL_PHASE1;
|
||||
}
|
||||
|
||||
void performHoming1() {
|
||||
Serial.println("[S1] Homing Motor 1: Phase 1 (Stall UP)");
|
||||
Serial.println("[S1] Homing Motor 1: Phase 1 (Stall OUTWARD)");
|
||||
stepper1.setMaxSpeed(1500);
|
||||
stepper1.setAcceleration(1500);
|
||||
stepper1.move(-1200);
|
||||
stepper1.move(2000);
|
||||
homingState = HOME_1_PHASE1;
|
||||
}
|
||||
|
||||
void performHoming2() {
|
||||
Serial.println("[S2] Homing Motor 2: Phase 1 (Stall UP)");
|
||||
Serial.println("[S2] Homing Motor 2: Phase 1 (Stall OUTWARD)");
|
||||
stepper2.setMaxSpeed(1500);
|
||||
stepper2.setAcceleration(1500);
|
||||
stepper2.move(1200);
|
||||
stepper2.move(-2000);
|
||||
homingState = HOME_2_PHASE1;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user