// Definování pinů pro ovládání motorů
int motor1pin1 = 3;  // První pin motoru 1
int motor1pin2 = 4;  // Druhý pin motoru 1
int motor2pin1 = 5;  // První pin motoru 2
int motor2pin2 = 6;  // Druhý pin motoru 2

// Funkce pro pohyb vpřed
void gofwd(int time) {
  digitalWrite(motor1pin1, LOW);   // Nastavení motoru 1 na směr dopředu
  digitalWrite(motor1pin2, HIGH);
  digitalWrite(motor2pin1, LOW);   // Nastavení motoru 2 na směr dopředu
  digitalWrite(motor2pin2, HIGH);
  delay(time * 1000); // Čekání po danou dobu v sekundách
}

// Funkce pro pohyb vzad
void gobwd(int time) {
  digitalWrite(motor1pin1, HIGH);  // Nastavení motoru 1 na směr dozadu
  digitalWrite(motor1pin2, LOW);
  digitalWrite(motor2pin1, HIGH);  // Nastavení motoru 2 na směr dozadu
  digitalWrite(motor2pin2, LOW);
  delay(time * 1000);
}

// Funkce pro zastavení motorů
void stop(int time) {
  digitalWrite(motor1pin1, LOW);   // Vypnutí motoru 1
  digitalWrite(motor1pin2, LOW);
  digitalWrite(motor2pin1, LOW);   // Vypnutí motoru 2
  digitalWrite(motor2pin2, LOW);
  delay(time * 1000);
}

// Funkce pro otočení doleva
void turnleft(int time) {
  digitalWrite(motor1pin1, LOW);   // Motor 1 se pohybuje dopředu
  digitalWrite(motor1pin2, HIGH);
  digitalWrite(motor2pin1, HIGH);  // Motor 2 se pohybuje dozadu
  digitalWrite(motor2pin2, LOW);
  delay(time * 1000);
}

// Funkce pro otočení doprava
void turnright(int time) {
  digitalWrite(motor1pin1, HIGH);  // Motor 1 se pohybuje dozadu
  digitalWrite(motor1pin2, LOW);
  digitalWrite(motor2pin1, LOW);   // Motor 2 se pohybuje dopředu
  digitalWrite(motor2pin2, HIGH);
  delay(time * 1000);
}

// *****************************************************************

void setup() {
  // Nastavení pinů motorů jako výstupní
  pinMode(motor1pin1, OUTPUT);
  pinMode(motor1pin2, OUTPUT);
  pinMode(motor2pin1, OUTPUT);
  pinMode(motor2pin2, OUTPUT);
}

void loop() {
  stop(3);       // Zastavení na 3 sekundy
  gofwd(1);      // Pohyb vpřed na 1 sekundu
  stop(1);       // Pauza na 1 sekundu
  gobwd(1);      // Pohyb vzad na 1 sekundu
  stop(1);       // Pauza na 1 sekundu
  turnleft(1);   // Otočení doleva na 1 sekundu
  stop(1);       // Pauza na 1 sekundu
  turnright(1);  // Otočení doprava na 1 sekundu
}