// analog vstup A0-A3 => monitor
// vzdálenost 11->Trig 12->Echo => monitor
// motory 2/3 4/5 směr/PWM

int pTrig = 11;
int pEcho = 12;
long odezva, vzdalenost;



void setup() {
  // dálkoměr
  pinMode(pTrig, OUTPUT);
  pinMode(pEcho, INPUT);
  // motory
  pinMode(2, OUTPUT);
  pinMode(3, OUTPUT);
  pinMode(4, OUTPUT);
  pinMode(5, OUTPUT);
  // sériový monitor
  Serial.begin(9600);
}

void loop() {
  Serial.println("Vpřed");
  digitalWrite(2, LOW);
  analogWrite(3, 127);
  digitalWrite(4, LOW);
  analogWrite(5, 127);
  delay(2000);
  Serial.println("Stop");
  digitalWrite(2, LOW);
  analogWrite(3, LOW);
  digitalWrite(4, LOW);
  digitalWrite(5, LOW);
  delay(2000);
  Serial.println("Vzad");
  digitalWrite(2, HIGH);
  analogWrite(3, 127);
  digitalWrite(4, HIGH);
  analogWrite(5, 127);
  delay(2000);
  Serial.println("Stop");
  digitalWrite(2, LOW);
  digitalWrite(3, LOW);
  digitalWrite(4, LOW);
  digitalWrite(5, LOW);
  delay(2000);
}