|
@ -372,7 +372,7 @@ void Press() { |
|
|
|
|
|
|
|
|
// Reset Press before every coffee
|
|
|
// Reset Press before every coffee
|
|
|
digitalWrite(invertWheelPin, HIGH); |
|
|
digitalWrite(invertWheelPin, HIGH); |
|
|
delay(1000); |
|
|
|
|
|
|
|
|
delay(100); |
|
|
digitalWrite(invertWheelPin, LOW); |
|
|
digitalWrite(invertWheelPin, LOW); |
|
|
|
|
|
|
|
|
digitalWrite(wheelPin, HIGH); |
|
|
digitalWrite(wheelPin, HIGH); |
|
@ -381,7 +381,7 @@ void Press() { |
|
|
while (true) { |
|
|
while (true) { |
|
|
delay(milliseconds); |
|
|
delay(milliseconds); |
|
|
if (digitalRead(wheelEndSensorPin) == HIGH) { |
|
|
if (digitalRead(wheelEndSensorPin) == HIGH) { |
|
|
delay(900); // extra delay added to compensate for slightly incorrect endstop placement after repair
|
|
|
|
|
|
|
|
|
delay(90); // extra delay added to compensate for slightly incorrect endstop placement after repair
|
|
|
digitalWrite(wheelPin, LOW); |
|
|
digitalWrite(wheelPin, LOW); |
|
|
delay(100); |
|
|
delay(100); |
|
|
Serial.write("Pressed\n"); |
|
|
Serial.write("Pressed\n"); |
|
@ -391,7 +391,7 @@ void Press() { |
|
|
delay(100); |
|
|
delay(100); |
|
|
Serial.write("p-end of pressing not detected\n"); |
|
|
Serial.write("p-end of pressing not detected\n"); |
|
|
digitalWrite(wheelPin, LOW); |
|
|
digitalWrite(wheelPin, LOW); |
|
|
unrecoverableErr = 1; |
|
|
|
|
|
|
|
|
unrecoverableErr = 1; //temporarily disabled because of failing sensor(s)
|
|
|
break; |
|
|
break; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
@ -406,7 +406,7 @@ void unPress() { |
|
|
|
|
|
|
|
|
// Reset Press before every coffee
|
|
|
// Reset Press before every coffee
|
|
|
digitalWrite(wheelPin, HIGH); |
|
|
digitalWrite(wheelPin, HIGH); |
|
|
delay(1500); |
|
|
|
|
|
|
|
|
delay(150); |
|
|
digitalWrite(wheelPin, LOW); |
|
|
digitalWrite(wheelPin, LOW); |
|
|
|
|
|
|
|
|
digitalWrite(invertWheelPin, HIGH); |
|
|
digitalWrite(invertWheelPin, HIGH); |
|
@ -415,7 +415,7 @@ void unPress() { |
|
|
while (true) { |
|
|
while (true) { |
|
|
delay(milliseconds); |
|
|
delay(milliseconds); |
|
|
if (digitalRead(wheelStartSensorPin) == HIGH) { |
|
|
if (digitalRead(wheelStartSensorPin) == HIGH) { |
|
|
delay(1500); |
|
|
|
|
|
|
|
|
delay(1000); |
|
|
digitalWrite(invertWheelPin, LOW); |
|
|
digitalWrite(invertWheelPin, LOW); |
|
|
delay(100); |
|
|
delay(100); |
|
|
Serial.write("UnPressed\n"); |
|
|
Serial.write("UnPressed\n"); |
|
@ -425,7 +425,7 @@ void unPress() { |
|
|
delay(100); |
|
|
delay(100); |
|
|
Serial.write("u-end of unPressing not detected\n"); |
|
|
Serial.write("u-end of unPressing not detected\n"); |
|
|
digitalWrite(invertWheelPin, LOW); |
|
|
digitalWrite(invertWheelPin, LOW); |
|
|
unrecoverableErr = 1; |
|
|
|
|
|
|
|
|
//unrecoverableErr = 1; //temporarily disabled because of failing sensor(s)
|
|
|
break; |
|
|
break; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|