#include <Servo.h>        // Servo Library is called. Will be needed, for the easier control of the servo motor  
 
Servo servoblue;          // For this programm here will be created a servo named „servoblue“
Servo servogreen;
Servo servored;

int LEDred = PD5; // Farbe rot an Pin PB2
int LEDgreen = PD3; // Colour blue on Pin PB1 (PWM)
int LEDblue = PD6; // Farbe gruen an Pin 6
int p = 3000; // p ist eine Pause mit 1000ms also 1 Sekunde
int brightness1a = 200; // Zahlenwert zwischen 0 und 255 – gibt die Leuchtstärke der einzelnen Farbe an
int brightness1b = 200; // Zahlenwert zwischen 0 und 255 – gibt die Leuchtstärke der einzelnen Farbe an
int brightness1c = 200; //  Zahlenwert zwischen 0 und 255 – gibt die Leuchtstärke der einzelnen Farbe an
int dark = 0; // Zahlenwert 0 bedeutet Spannung 0V – also LED aus.

 
void setup()
{

servoblue.attach(PD7);      // This is the Information that servo connecting
                            //the control wire (blue) is connected with  pin PD5 . You can take 
                            //any other pin for this connection.
servogreen.attach(PB4);   
servored.attach(PD4);

pinMode(LEDred, OUTPUT);
pinMode(LEDblue, OUTPUT);
pinMode(LEDgreen, OUTPUT);
pinMode(LEDred, OUTPUT);

}

void loop()

{     //In the „loop“ using the write-command „servoblue.write(Grad)“
      //the servo will be controled. Between the positions (Grd) there 
      //will be a pause, so the servo becommes enough time to reach the desired position.

servored.write(0);                  //Activate position 1 on servored with the angle 0 °
analogWrite(LEDred, brightness1a);  // red LED on
delay(p);                           //The program stops for p seconds


servogreen.write(0);                  //Activate position 1 on servogreen with the angle 0 °
analogWrite(LEDred, dark);            // red LED off
analogWrite(LEDgreen, brightness1b); // green LED on         
delay(p);  

servoblue.write(0);                   //Activate position 1 on servoblue with the angle 0 °
analogWrite(LEDgreen, dark);        // green LED off
analogWrite(LEDblue, brightness1c);   //  blue LED on
delay(p);            


servored.write(30);     //Activate position 2 on servored with the angle 30 °
analogWrite(LEDblue, dark);         // blue LED off
analogWrite(LEDred, brightness1a); 
delay(p);           

servogreen.write(30);   //Activate position 2 on servogreen with the angle 30 °
analogWrite(LEDred, dark);            // red LED off
analogWrite(LEDgreen, brightness1b);
delay(p);           

servoblue.write(30);    //Activate position 2 on servoblue with the angle 30 °
analogWrite(LEDgreen, dark);        // green LED off
analogWrite(LEDblue, brightness1c); 
delay(p);         



servored.write(60);     //Position 3 on servored control with the angle 60 °
analogWrite(LEDblue, dark);         // blue LED off
analogWrite(LEDred, brightness1a); 
delay(p);            

servogreen.write(60);   //Position 3 on servogreen control with the angle 60 °
analogWrite(LEDred, dark);            // red LED off
analogWrite(LEDgreen, brightness1b);
delay(p);            

servoblue.write(60);    //Position 3 on servoblue control with the angle 60 °
analogWrite(LEDgreen, dark);        // green LED off
analogWrite(LEDblue, brightness1c); 
delay(p);           



servored.write(30); 
analogWrite(LEDblue, dark);         // blue LED    
delay(p);           

servogreen.write(30);    
analogWrite(LEDgreen, brightness1b);
delay(p);

servoblue.write(30); 
analogWrite(LEDgreen, dark);        // green LED off
analogWrite(LEDblue, brightness1c); 
delay(p);


servored.write(15);
analogWrite(LEDblue, dark); 
delay(p);

servogreen.write(15); 
analogWrite(LEDgreen, brightness1b);
delay(p);

servoblue.write(15); 
analogWrite(LEDgreen, dark);        // green LED off
analogWrite(LEDblue, brightness1c); 
delay(p);



servored.write(0); 
analogWrite(LEDblue, dark); 
delay(p); 

servogreen.write(0); 
analogWrite(LEDgreen, brightness1b);
delay(p); 

servoblue.write(0); 
analogWrite(LEDgreen, dark);        // green LED off
analogWrite(LEDblue, brightness1c); 
delay(p); 

}