Pojazd

void setup() {
  // kolo I
  pinMode(6, OUTPUT);
  pinMode(7, OUTPUT);
  pinMode(8, OUTPUT);
  // kolo II
  pinMode(5, OUTPUT);
  pinMode(2, OUTPUT);
  pinMode(4, OUTPUT);
}

void przod1(int moc) {
  analogWrite(6, moc);
  digitalWrite(7, HIGH);
  digitalWrite(8, LOW);
}

void tyl1(int moc) {
  analogWrite(6, moc);
  digitalWrite(7, LOW);
  digitalWrite(8, HIGH);
}

void stop1() {
  digitalWrite(7, LOW);
  digitalWrite(8, LOW);
}

void przod2(int moc) {
  analogWrite(5, moc);
  digitalWrite(4, HIGH);
  digitalWrite(2, LOW);
}

void tyl2(int moc) {
  analogWrite(5, moc);
  digitalWrite(4, LOW);
  digitalWrite(2, HIGH);
}

void stop2() {
  digitalWrite(2, LOW);
  digitalWrite(4, LOW);
}

void przod(int moc) {
  przod1(moc);
  przod2(moc);
}

void tyl(int moc) {
  tyl1(moc);
  tyl2(moc);
}

void skretLewo(int moc) {
  przod1(moc);
  stop2();
}

void baczekLewo(int moc) {
  przod1(moc);
  tyl2(moc);
}

void skretPrawo(int moc) {
  stop1();
  przod2(moc);
}

void baczekPrawo(int moc) {
  tyl1(moc);
  przod2(moc);
}

void loop() {
  przod(255);
  delay(2000);
  tyl(255);
  delay(2000);
  tyl(255);
  delay(2000);
  baczekLewo(255);
  delay(2000);
  baczekPrawo(255);
  delay(2000);
  skretLewo(255);
  delay(2000);
  skretPrawo(255);
  delay(2000);
}