Почему робот не выполняет действие?

Question

[shinodaaa]

Работаю с роботом-манипулятором, суть чтобы после отправки в монитор порта строки, он считывал номер в коде указано как S1-5 и значение, после чего в зависимости от номера начинал работать определенный сервопривод, код рабочий, ардуино принимает, но сервы не работают. Проблем с распиновкой вроде нету.

#include <Servo.h>
#include <Arduino_JSON.h>

// const int ServoOnePin = 4;
const int ServoPlecho = 5;
const int ServoVrashenie = 3;
const int ServoPredplechie = 9;
const int ServoLapkaVrashenie = 11;
const int ServoLapka = 13;
// Servo servoOne;
Servo servoOne;
Servo servoTwo;
Servo servoThree;
Servo servoFour;
Servo servoFive;

// {"S1": 12}
String input = "";

void setup() {
  Serial.begin(9600);
  // pinMode(ServoOnePin, OUTPUT);
  pinMode(ServoPlecho, OUTPUT);
  pinMode(ServoVrashenie, OUTPUT);
  pinMode(ServoPredplechie, OUTPUT);
  pinMode(ServoLapkaVrashenie, OUTPUT);
  pinMode(ServoLapka, OUTPUT);
  servoOne.attach(ServoPlecho);
  servoTwo.attach(ServoVrashenie);
  servoThree.attach(ServoPredplechie);
  servoFour.attach(ServoLapkaVrashenie);
  servoFive.attach(ServoLapka);
}
void loop() {
  // put your main code here, to run repeatedly:
  if (Serial.available()) {
    while (Serial.available() > 0) {
      input += (char)Serial.read();
      delay(2);
    }
    Serial.println(input);
    JSONVar myObject = JSON.parse(input);
    if (JSON.typeof(myObject) == "undefined") {
      Serial.println("Parsing input failed!");
      return;
    }

    if (myObject.hasOwnProperty("S1")) {
      Serial.print("myObject[\"S1\"] = ");
      Serial.println((int)myObject["S1"]);
      int gr = (int)myObject["S1"];
      servoOne.write(gr);
      input = "";
    }

    if (myObject.hasOwnProperty("S2")) {
      Serial.print("myObject[\"S2\"] = ");
      Serial.println((int)myObject["S2"]);
      int gr = (int)myObject["S2"];
      servoOne.write(gr);
      input = "";
    }
    if (myObject.hasOwnProperty("S3")) {
      Serial.print("myObject[\"S3\"] = ");
      Serial.println((int)myObject["S3"]);
      int gr = (int)myObject["S3"];
      servoOne.write(gr);
      input = "";
    }
    if (myObject.hasOwnProperty("S4")) {
      Serial.print("myObject[\"S4\"] = ");
      Serial.println((int)myObject["S4"]);
      int gr = (int)myObject["S4"];
      servoOne.write(gr);
      input = "";
    }
    if (myObject.hasOwnProperty("S5")) {
      Serial.print("myObject[\"S5\"] = ");
      Serial.println((int)myObject["S5"]);
      int gr = (int)myObject["S5"];
      servoFive.write(gr);
      input = "";
    }  
  }
}

Comments

[Vindicar]

Ну у тебя в коде

servoOne.write(gr);
servoOne.write(gr);
servoOne.write(gr);
servoFive.write(gr);

Это так и надо?
Вообще я бы это сделал массивом, чтобы не повторять код сто раз.

Answer 1

[kalapanga]

1) Проверить работоспособность серв - закомментировать весь этот loop, а последними строчками в setup пошевелить всеми сервами (servoOne.write.... и т.п.). Работают - хорошо.
2) По коду везде расставлен вывод в serial отладочной информации (это хорошо). Так рассказывайте, что выводит-то!

Comments

[shinodaaa]

{"S5": 3}

myObject["S5"] = 3

Немного дополню ошибку, после выполнения команды, он перестает работать, и при подаче питания на него снова, он выполняет туда же команду.

[shinodaaa]

shinodaaa, еще добавлю, что работает почему-то робот таким образом, что сначала отправляется команда, но он ее не выполняет. Но если выключить подачу питания и подать снова, то он выполняет ее, и если его выключать и включать, будет выполняться одинаковая команда

[kalapanga]

shinodaaa, так один-то раз серва поворачивается или нет? Должна. Потом подаёте вторую команду, что выводится в монитор?

[shinodaaa]

kalapanga, в монитор выводится это

{"S5": 3} - команда

myObject["S5"] = 3 - вывод значения

Что касается поворотов, я задаю команду, он выполняет ее не сразу, для того чтобы он ее выполнил мне нужно выключить питание и подать его обратно, и если делать так много раз, то всегда будет выполняться предыдущая команда.

[kalapanga]

shinodaaa, "Выключить и подать питание" - забудьте это действие вообще. Что при этом происходит - абсолютно не интересно и не важно. Это только путает, не отвлекайтесь на него.

Вот Вы отправили команду. Что при этом происходит: а) вообще ничего, б) печатается текст команды, в) печатается текст команды, печатается результат парсинга, поворачивается серво?
Если (а), то попробуйте в мониторе порта поменять настройку передачи символов завершения строки (справа внизу рядом со скоростью.)

Answer 2

[archichi]

соберите схему в протеусе там все ардуино есть и подставляйте код и отладка будет вам в радость