Advertisement
tomateblue

Untitled

Jul 31st, 2017
132
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.33 KB | None | 0 0
  1. int in1 = 4;
  2. int in2 = 5;
  3. int in3 = 6;
  4. int in4 = 7;
  5.  
  6. int s1 = A0;
  7. int s2 = A1;
  8. int s3 = A2;
  9. int s4 = A3;
  10. int s5 = A4;
  11. int s6 = A5;
  12.  
  13. int esquerda_sensor1 = 0;
  14. int direita_sensor = 0;
  15. int esquerda_sensor = 0;
  16. int direita_sensor1 = 0;
  17. int esquerda_sensor2 = 0;
  18. int direita_sensor2 = 0;
  19.  
  20. void moto_andar() {
  21. digitalWrite(in1, HIGH);
  22. digitalWrite(in2, LOW);
  23. digitalWrite(in3, HIGH);
  24. digitalWrite(in4, LOW);
  25. delay(100);
  26. }
  27. void moto_direita() {
  28. digitalWrite(in1, HIGH);
  29. digitalWrite(in2, LOW);
  30. digitalWrite(in3, HIGH);
  31. digitalWrite(in4, HIGH);
  32. delay(100);
  33. }
  34. void moto_esquerda() {
  35. digitalWrite(in3, HIGH);
  36. digitalWrite(in4, LOW);
  37. digitalWrite(in1, HIGH);
  38. digitalWrite(in2, HIGH);
  39. delay(100);
  40. }
  41. void moto_stop() {
  42. digitalWrite(in3, HIGH);
  43. digitalWrite(in4, HIGH);
  44. digitalWrite(in1, HIGH);
  45. digitalWrite(in2, HIGH);
  46. delay(100);
  47. }
  48. void setup () {
  49. pinMode(s1, INPUT);
  50. pinMode(s2, INPUT);
  51. pinMode(s3, INPUT);
  52. pinMode(s4, INPUT);
  53. pinMode(s5, INPUT);
  54. pinMode(s6, INPUT);
  55. pinMode(in1, OUTPUT);
  56. pinMode(in2, OUTPUT);
  57. pinMode(in3, OUTPUT);
  58. pinMode(in4, OUTPUT);
  59. }
  60. void loop() {
  61. esquerda_sensor = digitalRead(s1);
  62. direita_sensor = digitalRead(s2);
  63. direita_sensor1 = digitalRead(s3);
  64. esquerda_sensor1 = digitalRead(s4);
  65. direita_sensor2 = digitalRead(s5);
  66. esquerda_sensor2 = digitalRead(s6);
  67. if(esquerda_sensor && direita_sensor)
  68. {
  69. moto_andar();
  70. moto_stop();
  71. }
  72.  
  73. if(!esquerda_sensor && direita_sensor )
  74. {
  75. moto_direita();
  76. moto_stop();
  77. }
  78.  
  79. if(esquerda_sensor && !direita_sensor)
  80. {
  81. moto_esquerda();
  82. moto_stop();
  83. }
  84.  
  85. if(!esquerda_sensor && !direita_sensor)
  86. {
  87. moto_stop();
  88. }
  89. if(esquerda_sensor1 && direita_sensor1)
  90. {
  91. moto_andar();
  92. moto_stop();
  93. }
  94. if(!esquerda_sensor1 && direita_sensor1)
  95. {
  96. moto_direita();
  97. moto_stop();
  98. }
  99. if(esquerda_sensor1 && !direita_sensor1)
  100. {
  101. moto_esquerda();
  102. moto_stop();
  103. }
  104. if(!esquerda_sensor1 && !direita_sensor1)
  105. {
  106. moto_stop();
  107. }
  108. if(esquerda_sensor2 && direita_sensor2)
  109. {
  110. moto_andar();
  111. moto_stop();
  112. }
  113. if(!esquerda_sensor2 && direita_sensor2)
  114. {
  115. moto_direita();
  116. moto_stop();
  117. }
  118.  
  119. if(esquerda_sensor2 && !direita_sensor2)
  120. {
  121. moto_esquerda();
  122. moto_stop();
  123. }
  124.  
  125. if(!esquerda_sensor2 && !direita_sensor2)
  126. {
  127. moto_stop();
  128. }
  129. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement