Advertisement
Guest User

robo

a guest
Jan 26th, 2020
116
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #include <Stepper.h>
  2.  
  3. double stepsPerRevolution = 2048;
  4. Stepper myStepper(stepsPerRevolution, 8, 10, 9, 11);
  5.  
  6. int sensor1 = A0;
  7. int sensor2 = A1;
  8. int end1 = 2;
  9. int end2 = 3;
  10.  
  11. int PRESSURE_THRESHOLD = 1000;
  12.  
  13. void setup()
  14. {
  15.   myStepper.setSpeed(10);  
  16.   Serial.begin(115200);
  17.   pinMode(end1, INPUT_PULLUP);
  18.   pinMode(end2, INPUT_PULLUP);
  19. }
  20. void loop()
  21. {
  22.   int value1 = analogRead(sensor1);
  23.   int value2 = analogRead(sensor2);
  24.   int val_min = min(value1, value2);
  25.   if (val_min < PRESSURE_THRESHOLD)
  26.   {
  27.     if (value1 == val_min)
  28.     {
  29.       if (digitalRead(end1) == HIGH)
  30.         myStepper.step(10);  
  31.     }
  32.     else
  33.       if (digitalRead(end2) == HIGH)
  34.         myStepper.step(-10);  
  35.   }
  36. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement