#include <Servo.h> 
 
Servo serwomechanizm_prawa_barek;  //Tworzymy obiekt, dzięki któremu możemy odwołać się do serwa 
int pozycja_prawa_barek = 0; //Aktualna pozycja serwa 0-180
int zmiana_prawa_barek = 6; //Co ile ma się zmieniać pozycja serwa?

Servo serwomechanizm_prawa_kolano;  
int pozycja_prawa_kolano = 0; 
int zmiana_prawa_kolano = 6; 

Servo serwomechanizm_lewa_barek; 
int pozycja_lewa_barek = 0; 
int zmiana_lewa_barek = 6;

Servo serwomechanizm_lewa_kolano;
int pozycja_lewa_kolano = 0; 
int zmiana_lewa_kolano = 6;

Servo serwomechanizm_prawa_tyl_barek; 
int pozycja_prawa_tyl_barek = 0; 
int zmiana_prawa_tyl_barek = 6; 

Servo serwomechanizm_prawa_tyl_kolano; 
int pozycja_prawa_tyl_kolano = 0; 
int zmiana_prawa_tyl_kolano = 6; 

Servo serwomechanizm_lewa_tyl_barek; 
int pozycja_lewa_tyl_barek = 0;
int zmiana_lewa_tyl_barek = 6; 

Servo serwomechanizm_lewa_tyl_kolano; 
int pozycja_lewa_tyl_kolano = 0;
int zmiana_lewa_tyl_kolano = 6;

Servo serwomechanizm_glowa_boki; 
int pozycja_glowa_boki = 0; 
int zmiana_glowa_boki = 6;

Servo serwomechanizm_glowa; 
int pozycja_glowa = 0; 

int zmiana_glowa = 6;
 
 Servo serwomechanizm_ogon; 
int pozycja_ogon = 0; 
int zmiana_ogon = 6; 

void setup() 
{ 
  serwomechanizm_prawa_barek.attach(5);  
  serwomechanizm_prawa_kolano.attach(3);  
  serwomechanizm_lewa_barek.attach(4);  
  serwomechanizm_lewa_kolano.attach(2);  
  serwomechanizm_prawa_tyl_barek.attach(9);  
  serwomechanizm_prawa_tyl_kolano.attach(7);  
  serwomechanizm_lewa_tyl_barek.attach(8);  
  serwomechanizm_lewa_tyl_kolano.attach(6);  
  serwomechanizm_glowa_boki.attach(1);  
  serwomechanizm_glowa.attach(10);  
  serwomechanizm_ogon.attach(11);
} 
 
void loop() 
{  
  for (pozycja_prawa_barek = 90; pozycja_prawa_barek <= 180; pozycja_prawa_barek += 1) { 
    serwomechanizm_prawa_barek.write(pozycja_prawa_barek);              
    delay(25);                       
  }
  
  pozycja_prawa_barek = pozycja_prawa_barek + zmiana_prawa_barek; //Zwiększenie aktualnej pozycji serwa
  delay(200); //Opóźnienie dla lepszego efektu   

  for (pozycja_prawa_kolano = 90; pozycja_prawa_kolano <= 180; pozycja_prawa_kolano += 1) { 
    serwomechanizm_prawa_barek.write(pozycja_prawa_kolano);              
    delay(25);                       
  }
  
  pozycja_prawa_kolano = pozycja_prawa_kolano + zmiana_prawa_kolano; //Zwiększenie aktualnej pozycji serwa
  delay(200); //Opóźnienie dla lepszego efektu  


  

}