Advertisement
Gasolin

Floppy Drivercode

Oct 14th, 2013
431
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.55 KB | None | 0 0
  1. int i = 0;
  2. boolean dir = true;
  3. boolean st = false;
  4. int wait = 4;
  5.  
  6. void setup() {
  7.   pinMode(2, OUTPUT);  //Step
  8.   pinMode(3, OUTPUT);  //Direction
  9.   digitalWrite(2, HIGH);
  10.   digitalWrite(3, HIGH);
  11. }
  12.  
  13. void loop() {
  14.   if(i >= 156) {
  15.     dir = false;
  16.     digitalWrite(3, LOW);
  17.   } else if(i <=0) {
  18.     dir = true;
  19.     digitalWrite(3, HIGH);
  20.   }
  21.  
  22.   if(dir) {
  23.     i++;
  24.   } else {
  25.     i--;
  26.    
  27.   }
  28.   if(st) {
  29.     digitalWrite(2, LOW);
  30.     st = false;
  31.   } else {
  32.     digitalWrite(2, HIGH);
  33.     st = true;
  34.   }
  35.  
  36.   delay(wait);
  37. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement