#include <Servo.h> 
 
Servo serwomechanizm;   
int pozycja = 0; 
int zmiana = 6; 
 
#define zielonapiesi 8
#define czerwonapiesi 10
#define zoltapiesi 9
#define zolta 4
#define zielona 3
#define czerwona 5
String odebraneDane = ""; 

void setup() {
  serwomechanizm.attach(1);  
  pinMode(czerwonapiesi, OUTPUT); 
  pinMode(zoltapiesi, OUTPUT); 
  pinMode(zielonapiesi, OUTPUT); 
 pinMode(zolta, OUTPUT);
 pinMode(czerwona, OUTPUT);
 pinMode(zielona, OUTPUT);

  pinMode(7, INPUT_PULLUP); //Przycisk
 
  digitalWrite(czerwonapiesi, LOW); 
  digitalWrite(zoltapiesi, LOW);
  digitalWrite(zielonapiesi, LOW);
  digitalWrite(zolta, LOW);
  digitalWrite(zielona, LOW);
  digitalWrite(czerwona, LOW);
}
 
void loop() {
  digitalWrite(czerwonapiesi, HIGH); 
  digitalWrite(zielona, HIGH); 

  delay(1000); 
  while (digitalRead(7) == HIGH) {}
   
	delay(2000);

  digitalWrite(czerwona, LOW); 
  digitalWrite(zolta, HIGH); 
  digitalWrite(zielona, LOW); 

  for (pozycja = 90; pozycja <= 180; pozycja += 1) { 
    serwomechanizm.write(pozycja);              
    delay(25);                       
  }

	delay(2000);

  digitalWrite(czerwona, HIGH); 
  digitalWrite(zolta, LOW); 
  digitalWrite(zielona, LOW); 

  delay(2000);

  digitalWrite(czerwonapiesi, LOW); 
  digitalWrite(zoltapiesi, HIGH); 
  digitalWrite(zielonapiesi, LOW); 

	
  delay(2000); 
	
  digitalWrite(czerwonapiesi, LOW); 
  digitalWrite(zoltapiesi, LOW); 
  digitalWrite(zielonapiesi, HIGH); 
	
  delay(4000); 
	
 digitalWrite(czerwonapiesi, LOW); 
  digitalWrite(zoltapiesi, HIGH);
  digitalWrite(zielonapiesi, LOW); 
  
  delay(2000);

  digitalWrite(czerwonapiesi, HIGH); 
  digitalWrite(zoltapiesi, LOW); 
  digitalWrite(zielonapiesi, LOW);

  delay(4000);

  for (pozycja = 180; pozycja >= 90; pozycja -= 1) { 
    serwomechanizm.write(pozycja);              
    delay(25);                      
  }

  digitalWrite(zolta, HIGH);
  digitalWrite(czerwona, LOW);
  digitalWrite(zielona, LOW);

  delay(2000);

  digitalWrite(zolta, LOW);
  digitalWrite(zielona, HIGH);
	
}