Advertisement
m_i_k_o_l_a_j

Untitled

Nov 13th, 2019
115
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.03 KB | None | 0 0
  1. int enA = 10; // zadeklarowanie pinow do silnika
  2. int in1 = 9;
  3. int in2 = 8;
  4. int enB = 5;
  5. int in3 = 7;
  6. int in4 = 6;//
  7.  
  8.  
  9. void setup() {
  10.  
  11. pinMode(A3, INPUT);
  12. pinMode(A5, INPUT);
  13. pinMode(A4, INPUT);
  14. pinMode(13, LED_BUILTIN);
  15.  
  16. Serial.begin(9600);
  17.  
  18. }
  19.  
  20. boolean sensor1() {
  21. if(analogRead(A5) < 750) {
  22. return 0;
  23. }
  24. else {
  25. return 1;
  26.  
  27. }
  28. }
  29. boolean sensor2() {
  30. if(analogRead(A4) < 750) {
  31. return 0;
  32. }
  33. else {
  34. return 1;
  35. }
  36. }
  37.  
  38. boolean sensor3() {
  39. if(analogRead(A3) < 750) {
  40. return 0;
  41. }
  42. else {
  43. return 1;
  44. }
  45. }
  46.  
  47. void lewysilnik() {
  48. digitalWrite(in1, HIGH);// wpisanie pinowi stanu wysokiego
  49. digitalWrite(in2, LOW);// wpisanie pinowi stanu niskiego
  50. analogWrite(enA, 255);// wpisanie predkosci silnika (0 do 255) na pin enA
  51. }
  52.  
  53. void prawysilnik() {
  54.  
  55. digitalWrite(in3, HIGH);// wpisanie pinowi stanu wysokiego
  56. digitalWrite(in4, LOW);// wpisanie pinowi stanu niskiego
  57. analogWrite(enB, 255);// wpisanie predkosci silnika (0 do 255) na pin enB
  58. }
  59.  
  60. void zatrzymaj() {
  61. analogWrite(enA, 0);// wylaczenie silnikow
  62. analogWrite(enB, 0);//
  63. }
  64.  
  65. void loop() {
  66.  
  67. int odczyt = analogRead(A3);
  68. int odczyt1 = analogRead(A4);
  69. int odczyt2 = analogRead(A5);
  70.  
  71.  
  72. Serial.println(odczyt1);
  73. Serial.println(odczyt2);
  74. Serial.println(odczyt);
  75.  
  76. if (sensor1() == 1 && sensor2() == 1 && sensor3() == 1) { //Jesli oba czujniki widza linii
  77. lewysilnik();
  78. prawysilnik();
  79. }
  80. else if (sensor1() == 0 && sensor2() == 1 && sensor3() == 0) { //Jesli oba czujniki widza linii
  81. lewysilnik();
  82. prawysilnik();
  83. }
  84. else if (sensor1() == 1 && sensor2() == 0 && sensor3() == 0) { //Jesli oba czujniki widza linii
  85. zatrzymaj();
  86. lewysilnik();
  87. }
  88. else if (sensor1() == 0 && sensor2() == 0 && sensor3() == 1) { //Jesli oba czujniki widza linii
  89. zatrzymaj();
  90. prawysilnik();
  91. }
  92. else if (sensor1() == 0 && sensor2() == 0 && sensor3() == 0) { //Jesli oba czujniki widza linii
  93. zatrzymaj();
  94. }
  95.  
  96.  
  97. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement