Servo и Serial

код на заметку, как можно из консольки пихать угол поворота для сервопривода (3 дырка и угол в виде циферки|, например 2| или 90|)

#include <Servo.h>

Servo myservo;
int pos = 0;
char inByte;
char buffer[6];
int ind=0;

void setup()
{
  Serial.begin(9600);
  myservo.attach(3);
}


void loop()
{
  if (Serial.available() > 0) {
    inByte = Serial.read();
   if (inByte >= '0' && inByte <='9' && ind<5) {
      buffer[ind++]=inByte;
    } else if (inByte=='|') {
      buffer[ind]=0;
      pos=atoi(buffer);
        Serial.println(pos);
        if (pos>=0 && pos <=180) {
          myservo.write(pos);
        }
      ind=0;
    }
  }

}

Комментариев нет:

Отправить комментарий