Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Stepper.h>
- const int sensorpin = A0;
- int stepsturn = 485;
- int fullturn = 1479;
- int closest = 0;
- int x = 0;
- int steps = 0;
- Stepper myStepper1(200,12,11);
- Stepper myStepper2(200,4,3);
- int i = 0;
- int q = 0;
- int z = 0;
- void setup()
- {
- pinMode(sensorpin,INPUT);
- myStepper1.setSpeed(150);//left
- myStepper2.setSpeed(150);//right
- analogReference(EXTERNAL);
- }
- void loop()
- {
- i=0;
- q=0;
- z=0;
- while (i<fullturn){
- myStepper1.step(1);
- myStepper2.step(1);
- x = analogRead(sensorpin);
- i=i+1;
- if(x>closest){
- closest=x;
- steps = i;}
- x = 0;
- delay(5);
- }
- while(z<steps){
- myStepper1.step(1);
- myStepper2.step(1);
- z++;}
- while(analogRead(sensorpin)<950){
- myStepper1.step(1);
- myStepper2.step(-1); }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement