View difference between Paste ID: cjasVzpW and 6d4tpFyC

 #include <Servo.h>
 
-Servo myservo;  // create Servo object to control a servo
+//Servo connection PINs
 int spin[4] = {2,3,4,5};
 int sangle[4] = {0,90,180,90};
 Servo myservo[4];  // create Servo object to control a servo
-  myservo.attach(2);                  // attaches the servo on pin 2 to the Servo object
+
-  myservo.write(90);                  // sets the servo position to midle 90
+char c;     //character
 bool d = false;     //are new data
 
 void readChar() {
-  myservo.write(0);                  // sets the servo position 0
+    if (Serial.available() > 0) {
-  delay(1000);                       // waits 1s
+        c = Serial.read();
-  myservo.write(90);                 // sets the servo position 90
+        d = true;
-  delay(1000);                       // waits 1s
+        Serial.print("pushed: ");
-  myservo.write(180);                // sets the servo position 180
+        Serial.println(c);
-  delay(1000);                       // waits 1s
+    }
 }
 
 void setservos(int a){
   for (int s = 0;s < 4;s++) {
     Serial.print("servo: ");
     Serial.print(s);
     Serial.print(" Angle: ");
     Serial.println(a);
     myservo[s].write(a);        // sets the servo position
     delay(250);
   }
 }
 
 void stest() {
   for (int i = 0; i < 4; i++){
     setservos(sangle[i]);
     delay(500);
   }
 }
 
 void setup() {
   Serial.begin(9600);
   Serial.println("Arduino is ready");
   Serial.println("Write leater t-est, r-ight, m-idle, l-eft");
   for (int s = 0;s < 4;s++) {
     myservo[s].attach(spin[s]);  // attaches the servos on pins
     myservo[s].write(90);        // sets the servo position to midle
   }
 }
 
 void loop() {
   readChar();
   if (d == true) {
     if (c == 't') {
       Serial.println("Servo test");
       stest();
     }
     if (c == 'r') {
       Serial.println("Servo to right");
       setservos(0);
     }
     if (c == 'm') {
       Serial.println("Servo to midle");
       setservos(90);
     }
     if (c == 'l') {
       Serial.println("Servo to left");
       setservos(180);
     }
     d = false;
   }
 }