Advertisement
Guest User

Untitled

a guest
Oct 21st, 2019
103
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.35 KB | None | 0 0
  1. #define SE A4 //sensor esq
  2. #define SDir A5 //esnsor d
  3. #define rodaEsq 11
  4. #define rodaDir 3
  5. int maxMotor = 110; //na tomada 60
  6. int minMotor = 0; // na tomada 30
  7. int LIMIAR = 200;
  8. int x = 0;
  9. int y = 0;
  10.  
  11. // 11 -> direita e devagar
  12. // Lendo o sensor de cor
  13.  
  14. void setup() {
  15. // put your setup code here, to run once:
  16. Serial.begin(9600);
  17. pinMode(12,OUTPUT); /* Motor */
  18. pinMode(13,OUTPUT); /* Motor */
  19. pinMode(rodaDir,OUTPUT); /* Roda direita */
  20. pinMode(rodaEsq,OUTPUT); /* Roda esquerda */
  21. pinMode(SDir,INPUT); /*Sensor direita*/
  22. pinMode(SE,INPUT); /*Sensor esquerda*/
  23. digitalWrite(12,LOW);
  24. digitalWrite(13,LOW);
  25. analogWrite(rodaEsq, 255);
  26. analogWrite(rodaDir, 255);
  27.  
  28. delay(30);
  29. }
  30.  
  31. void loop() {
  32. Serial.print("Sensor Esq.: ");
  33. Serial.print(analogRead(SE));
  34. Serial.print(" | Sensor Dir.: ");
  35. Serial.println(analogRead(SDir));
  36.  
  37. if(analogRead(SE)<LIMIAR && analogRead(SDir)<LIMIAR){ //se os 2 tiver no branco
  38. analogWrite(rodaEsq, maxMotor);
  39. analogWrite(rodaDir, maxMotor);
  40. } else if (analogRead(SE)>LIMIAR){ //carrinho vai pra direita
  41. analogWrite(rodaDir, maxMotor);
  42. analogWrite(rodaEsq, minMotor);
  43. } else if (analogRead(SDir)>LIMIAR){ //carrinho vai pra esquerda
  44. analogWrite(rodaEsq, maxMotor);
  45. analogWrite(rodaDir, minMotor);
  46. }
  47.  
  48. delay(5);
  49. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement