#include <Servo.h>//servos um-90° drehen bevor start

Servo s1p;
const int s1p1 = 0;
const int s1p2 = -25;
int s1v1;
int s1v2;
int s1a;

Servo s2p;
const int s2p1 = 51;
const int s2p2 = -25;
int s2v1;
int s2v2;
int s2a;
//const int k=–90;

const int zp1 = 25; const int zp2 = -51;

void setup() {
  // put your setup code here, to run once:
  s1p.attach(5);
  s2p.attach(6);
  Serial.begin(9600);
    s1p.write(0); s2p.write(0);
delay(500);
  s1p.write(180); s2p.write(180);
delay(500);
}

void loop() {
  // put your main code here, to run repeatedly:
  s1v1 = zp1 - s1p1;
  s1v2 = zp2 - s1p2;
  s1a = (atan(s1v2 / s1v1) * 180) / PI;

  s2v1 = zp1 - s2p1;
  s2v2 = zp2 - s2p2;
  s2a = (atan(s2v2 / s2v1) * 180) / PI;
  Serial.print("s1a:");Serial.println(s1a);
  Serial.print("s2a:");Serial.println(s2a);
  s1p.write(s1a); s2p.write(s2a);
  delay(20);
}