#include <Servo.h>

Servo A; Servo B; Servo C; Servo D; Servo E; Servo F; Servo G; Servo H; Servo I; Servo J; Servo K; Servo L; Servo M;
Servo N; Servo O; Servo P; Servo Q; Servo R;


void setup() {


pinMode(A15, OUTPUT);
A.attach(22); B.attach(23); C.attach(24); D.attach(25); E.attach(26); F.attach(27);



pinMode(A14, OUTPUT);
G.attach(28); H.attach(29); I.attach(30); J.attach(33); K.attach(32); L.attach(31);



pinMode(A13, OUTPUT);
M.attach(36); N.attach(35); O.attach(34); P.attach(39); Q.attach(38); R.attach(37);

//Serial.begin(9600); // Ausgabe starten
//Serial.println("Start"); // gibt start aus

}

void Strom_an(){
//digitalWrite(A13, HIGH);
//digitalWrite(A14, HIGH);
digitalWrite(A15, HIGH);
}

void Strom_aus(){
//digitalWrite(A13, LOW);
//digitalWrite(A14, LOW);
digitalWrite(A15, LOW);
}

// A=22; B=23; C=24; D=25; E=26; F=27; G=28; H= 29; I=30
// J= 31; K=32; L=33; M=34; N=35; O=36; P=37; Q=38; R=39;

// Home Position:  A=125  B=20 C=180 D=170 E=5 F= 165 G=145 H= 5 I= 170 J=60 K=180 L= 15 M=25 N=180 O= 30 P=65
// Q= 180 R= 25

void Home(){
  A.write(125); B.write(20); C.write(180); D.write(170); E.write(5); F.write(165); G.write(145); H.write(5);
  I.write(170); J.write(60); K.write(180); L.write(15); M.write(25); N.write(180); O.write(30); P.write(65);
  Q.write(180); R.write(25);
  }

void loop(){
Strom_an();
Home();
Strom_aus();

delay(4000);
}