Advertisement
Guest User

Untitled

a guest
May 28th, 2018
72
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.92 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3.  
  4. #define CLK 9
  5. #define DT 8
  6. #define SW 7
  7.  
  8. int ROTPOS = 0;
  9. int CURRENT = 0;
  10. int BEFORE = 0;
  11. int LR = 0;
  12. int LEFT = 1;
  13. int RIGHT = -1;
  14.  
  15.  
  16. Servo myservo;
  17.  
  18. void setup() {
  19.  
  20. Serial.begin(9600);
  21. pinMode(CLK,INPUT);
  22. pinMode(DT,INPUT);
  23.  
  24. pinMode(SW,INPUT);
  25.  
  26. BEFORE = digitalRead(CLK);
  27.  
  28.  
  29. myservo.attach(13);
  30.  
  31. }
  32.  
  33. void loop() {
  34. CURRENT = digitalRead(CLK);
  35. if(CURRENT != BEFORE){
  36. if(digitalRead(DT) != CURRENT){
  37. if(ROTPOS<180 && ROTPOS >=0)ROTPOS++;
  38. LR = LEFT;
  39. }
  40. else{
  41. if(ROTPOS<=180 && ROTPOS >0)ROTPOS--;
  42. LR = RIGHT;
  43. }
  44.  
  45. if(LR == LEFT){
  46. Serial.print("RIGHT ");
  47. }
  48.  
  49. if(LR == RIGHT){
  50. Serial.print("LEFT ");
  51. }
  52. myservo.write(ROTPOS);
  53. delay(15);
  54.  
  55. Serial.println(ROTPOS);
  56.  
  57. }
  58.  
  59. if(digitalRead(SW) == LOW){
  60. Serial.println("klik");
  61. }
  62. BEFORE = CURRENT;
  63. delay(100);
  64. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement