Advertisement
andretafta

Line Follower ESP AMICA + SHIELD

Mar 27th, 2024 (edited)
770
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1.  void Stop() {
  2.   // Motor Kiri
  3.   pinMode(5,OUTPUT);
  4.    pinMode(0,OUTPUT);
  5.    analogWrite(5,0);
  6.    analogWrite(0,0);
  7.   // Motor Kanan
  8.   pinMode(4,OUTPUT);
  9.    pinMode(2,OUTPUT);
  10.    analogWrite(4,0);
  11.    analogWrite(2,0);
  12. }
  13.  
  14. void Forward() {
  15.   pinMode(5,OUTPUT);
  16.    pinMode(0,OUTPUT);
  17.    analogWrite(5,125);
  18.    analogWrite(0,0);
  19.   pinMode(4,OUTPUT);
  20.    pinMode(2,OUTPUT);
  21.    analogWrite(4,125);
  22.    analogWrite(2,0);
  23. }
  24.  
  25. void Left() {
  26.   pinMode(5,OUTPUT);
  27.    pinMode(0,OUTPUT);
  28.    analogWrite(5,0);
  29.    analogWrite(0,95);
  30.   pinMode(4,OUTPUT);
  31.    pinMode(2,OUTPUT);
  32.    analogWrite(4,95);
  33.    analogWrite(2,0);
  34. }
  35.  
  36. void Right() {
  37.   pinMode(5,OUTPUT);
  38.    pinMode(0,OUTPUT);
  39.    analogWrite(5,95);
  40.    analogWrite(0,0);
  41.   pinMode(4,OUTPUT);
  42.    pinMode(2,OUTPUT);
  43.    analogWrite(4,0);
  44.    analogWrite(2,95);
  45. }
  46.  
  47.  
  48. void setup() {
  49.   pinMode(12, INPUT);
  50.   pinMode(13, INPUT);
  51.  
  52. }
  53.  
  54. void loop() {
  55.     if (digitalRead(12) == 1 & digitalRead(13) == 1) {
  56.       Stop();
  57.     }
  58.     if (digitalRead(12) == 0 & digitalRead(13) == 1) {
  59.       Right();
  60.     }
  61.     if (digitalRead(12) == 1 & digitalRead(13) == 0) {
  62.       Left();
  63.     }
  64.     if (digitalRead(12) == 0 & digitalRead(13) == 0) {
  65.       Forward();
  66.     }
  67.  
  68. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement