Advertisement
MadBromance

Linienfolger, langsam (ohne Gabellichtschranke)

Dec 7th, 2019
133
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.64 KB | None | 0 0
  1. #define LS 2 // left sensor
  2.  
  3. #define RS 7 // right sensor
  4.  
  5.  
  6.  
  7. /*-------definning Outputs------*/
  8.  
  9. #define LM1 4 // left motor // motor 2
  10.  
  11. #define LM2 5 // left motor // motor 1
  12.  
  13. #define RM1 6 // right motor // motor 4
  14.  
  15. #define RM2 7 // right motor // motor 3
  16.  
  17.  
  18.  
  19. int motor1 = 3;
  20.  
  21. int motor2 = 5;
  22.  
  23. int motor3 = 10;
  24.  
  25. int motor3 = 11;
  26.  
  27.  
  28.  
  29. void setup()
  30.  
  31. {
  32.  
  33. pinMode(LS, INPUT);
  34.  
  35. pinMode(RS, INPUT);
  36.  
  37. pinMode(motor1, OUTPUT);
  38.  
  39. pinMode(motor2, OUTPUT);
  40.  
  41. pinMode(motor3, OUTPUT);
  42.  
  43. pinMode(motor4, OUTPUT);
  44.  
  45. }
  46.  
  47.  
  48.  
  49. void loop()
  50.  
  51. {
  52.  
  53. if(digitalRead(LS) && digitalRead(RS)) // Move Forward
  54.  
  55. {
  56.  
  57. analogWrite(motor1, 0);
  58.  
  59. analogWrite(motor2, 25);
  60.  
  61. analogWrite(motor3, 0),
  62.  
  63. analogWrite(motor4, 25);
  64.  
  65. delay(100); // Eine Sekunde Warten
  66.  
  67. }
  68.  
  69.  
  70.  
  71. if(digitalRead(LS) && !(digitalRead(RS))) // Turn right
  72.  
  73. {
  74.  
  75. analogWrite(motor1, 0);
  76.  
  77. analogWrite(motor2, 0);
  78.  
  79. analogWrite(motor3, 0);
  80.  
  81. analogWrite(motor4, 25);
  82.  
  83. delay(100); // Eine Sekunde Warten
  84.  
  85. }
  86.  
  87.  
  88.  
  89. if(!(digitalRead(LS)) && digitalRead(RS)) // turn left
  90.  
  91. {
  92.  
  93. analogWrite(motor1, 0);
  94.  
  95. analogWrite(motor2, 25);
  96.  
  97. analogWrite(motor3, 0);
  98.  
  99. analogWrite(motor4, 0);
  100.  
  101. delay(100); // Eine Sekunde Warten
  102.  
  103. }
  104.  
  105.  
  106.  
  107. if(!(digitalRead(LS)) && !(digitalRead(RS))) // stop
  108.  
  109. {
  110.  
  111. analogWrite(motor1, 0);
  112.  
  113. analogWrite(motor2, 0);
  114.  
  115. analogWrite(motor3, 0);
  116.  
  117. analogWrite(motor4, 0);
  118.  
  119. delay(100); // Eine Sekunde Warten
  120.  
  121. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement