|
@@ -52,6 +52,10 @@ Atm_TeensyStep Y_top_step;
|
|
|
Stepper Y_top_stepper(22 , 21);
|
|
|
StepControl Y_top_controller ;
|
|
|
|
|
|
+Atm_fade peristaltic;
|
|
|
+int peristaltic_pwm_pin = 3;
|
|
|
+int peristaltic_dir_pin = 2;
|
|
|
+
|
|
|
|
|
|
|
|
|
void setup() {
|
|
@@ -95,13 +99,23 @@ void setup() {
|
|
|
|
|
|
|
|
|
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ peristaltic.begin( peristaltic_pwm_pin ).blink( 2000 ).fade( 50 );
|
|
|
+ peristaltic.start();
|
|
|
+
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void loop() {
|
|
|
-
|
|
|
automaton.run();
|
|
|
Udp.beginPacket(ipMulti, portMulti);
|
|
|
bndl.send(Udp);
|
|
@@ -126,11 +140,11 @@ void loop() {
|
|
|
}
|
|
|
|
|
|
|
|
|
- Serial.print(analogRead(A3));
|
|
|
- Serial.print(" ");
|
|
|
- Serial.print(Y_top_step.limitState[0]);
|
|
|
- Serial.print(" ");
|
|
|
- Serial.println(X_top_step.limitState[1]);
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
|
|
|
|
|
|
|