#include <Servo.h>
// String readString;
Servo myservo1;
Servo myservo2;
Servo myservo3;
// int pos = 0; // variable to store the servo position
int vlez = 0;
char PTPString[]="PTP {A1 45, A2 30, A3 0}";
int ind1;
void setup() {
myservo1.attach(3);
myservo2.attach(5);
myservo3.attach(9);
Serial.begin(9600);
Serial.println("Серво мотор контролиран со влез од тастатура");
Serial.println("-------------------------------");
}
void loop() {
while (Serial.available() > 1) { // Чека внесување на број
// vlez = Serial.parseInt();
// PTPString = Serial.read();
Serial.print(PTPString);
// ind1 = PTPString.indexOf('T');
// Serial.print("Позиција=");
// Serial.println(vlez);
// Serial.print(ind1);
}
myservo1.write(vlez);
myservo2.write(vlez*2);
myservo3.write(vlez/2); // tell servo to go to position in variable 'pos'
}