Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- Servo myservo;
- String strData = "";
- boolean recievedFlag;
- // 1 шилд для основных моторов
- #define IN1 5
- #define IN2 4
- #define IN3 3
- #define IN4 2
- // 2 шилд для клешни
- #define INTWO1 9
- #define INTWO2 8
- #define INTWO3 7
- #define INTWO4 6
- void setup() {
- Serial.begin(9600);
- }
- void loop() {
- strData = "";
- while (Serial.available() > 0) { // ПОКА есть что то на вход
- strData += (char)Serial.read(); // забиваем строку принятыми данными
- recievedFlag = true; // поднять флаг что получили данные
- delay(2); // ЗАДЕРЖКА. Без неё работает некорректно!
- }
- if (recievedFlag) { // если данные получены
- Serial.println(strData); // вывести
- recievedFlag = false; // опустить флаг
- }
- // движение
- if (strData == "B")
- {
- Serial.println(strData);
- digitalWrite(IN1, HIGH);
- digitalWrite(IN2, LOW);
- digitalWrite(IN3, HIGH);
- digitalWrite(IN4, LOW);
- }
- if (strData == "F")
- {
- Serial.println(strData);
- digitalWrite(IN1, LOW);
- digitalWrite(IN2, HIGH);
- digitalWrite(IN3, LOW);
- digitalWrite(IN4, HIGH);
- }
- if (strData == "S")
- {
- Serial.println(strData);
- digitalWrite(IN1, LOW);
- digitalWrite(IN2, LOW);
- digitalWrite(IN3, LOW);
- digitalWrite(IN4, LOW);
- }
- if (strData == "L")
- {
- digitalWrite(IN1, HIGH);
- digitalWrite(IN2, LOW);
- digitalWrite(IN3, LOW);
- digitalWrite(IN4, HIGH);
- }
- if (strData == "R")
- {
- digitalWrite(IN1, LOW);
- digitalWrite(IN2, HIGH);
- digitalWrite(IN3, HIGH);
- digitalWrite(IN4, LOW);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement