bool test_prvy = true;
bool test_druhy = true;
void setup()
{
PORTD |= 1 << 4;
DDRD |= 1 << 7;
PORTD &= ~(1 << 6);
DDRD |= 1 << 5;
DDRD &= ~(1<<2);
PORTD |= 1<<2;
DDRD &= ~(1<<3);
PORTD |= 1<<3;
Serial.begin(9600);
Serial.println("Kalibrujem prvý motor.");
}
void loop()
{
while((PIND&(1<<3)) != 0 && test_prvy == true)
{
krok1();
}
if((PIND&(1<<3)) == 0 && test_prvy == true)
{
Serial.println("Prvý motor dokalibrovaný.");
test_prvy = false;
PORTD |= 1 << 6;
Serial.println("Vraciam sa trocha späť.");
for(int i = 0; i < 10; i++)
{
krok1();
}
Serial.println("Kalibrujem druhý motor.");
}
while((PIND&(1<<2)) != 0 && test_druhy == true)
{
krok2();
}
if((PIND&(1<<2)) == 0 && test_druhy == true)
{
Serial.println("Druhý motor dokalibrovaný.");
test_druhy = false;
PORTD &= ~(1 << 4);
Serial.println("Vraciam druhý motor trocha späť.");
for(int i = 0; i < 10; i++)
{
krok2();
}
Serial.println("Dokalibrované!");
}
}
void krok1()
{
PORTD |= 1 << 7;
delay(50);
PORTD &= ~(1 << 7);
delay(50);
}
void krok2()
{
PORTD |= 1 << 5;
delay(50);
PORTD &= ~(1 << 5);
delay(50);
}