Advertisement
_TEXNIK_

carcode

Apr 1st, 2023
17
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.93 KB | None | 0 0
  1. #include <Servo.h>
  2. Servo myservo;
  3.  
  4. String strData = "";
  5. boolean recievedFlag;
  6.  
  7. // 1 шилд для основных моторов
  8. #define IN1 5
  9. #define IN2 4
  10. #define IN3 3
  11. #define IN4 2
  12.  
  13. // 2 шилд для клешни
  14. #define INTWO1 9
  15. #define INTWO2 8
  16. #define INTWO3 7
  17. #define INTWO4 6
  18.  
  19. void setup() {
  20. Serial.begin(9600);
  21.  
  22. }
  23.  
  24. void loop() {
  25. strData = "";
  26.  
  27. while (Serial.available() > 0) { // ПОКА есть что то на вход
  28. strData += (char)Serial.read(); // забиваем строку принятыми данными
  29. recievedFlag = true; // поднять флаг что получили данные
  30. delay(2); // ЗАДЕРЖКА. Без неё работает некорректно!
  31. }
  32.  
  33. if (recievedFlag) { // если данные получены
  34. Serial.println(strData); // вывести
  35. recievedFlag = false; // опустить флаг
  36. }
  37.  
  38. // движение
  39. if (strData == "B")
  40. {
  41. Serial.println(strData);
  42. digitalWrite(IN1, HIGH);
  43. digitalWrite(IN2, LOW);
  44. digitalWrite(IN3, HIGH);
  45. digitalWrite(IN4, LOW);
  46. }
  47. if (strData == "F")
  48. {
  49.  
  50. Serial.println(strData);
  51. digitalWrite(IN1, LOW);
  52. digitalWrite(IN2, HIGH);
  53. digitalWrite(IN3, LOW);
  54. digitalWrite(IN4, HIGH);
  55. }
  56.  
  57. if (strData == "S")
  58. {
  59.  
  60. Serial.println(strData);
  61. digitalWrite(IN1, LOW);
  62. digitalWrite(IN2, LOW);
  63. digitalWrite(IN3, LOW);
  64. digitalWrite(IN4, LOW);
  65. }
  66.  
  67.  
  68. if (strData == "L")
  69. {
  70. digitalWrite(IN1, HIGH);
  71. digitalWrite(IN2, LOW);
  72. digitalWrite(IN3, LOW);
  73. digitalWrite(IN4, HIGH);
  74. }
  75.  
  76. if (strData == "R")
  77. {
  78. digitalWrite(IN1, LOW);
  79. digitalWrite(IN2, HIGH);
  80. digitalWrite(IN3, HIGH);
  81. digitalWrite(IN4, LOW);
  82. }
  83.  
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement