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);
}