#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
}