// 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() {
  // načtení vzdálenosti
  digitalWrite(pTrig, LOW);
  delayMicroseconds(2);
  digitalWrite(pTrig, HIGH);
  delayMicroseconds(5);
  digitalWrite(pTrig, LOW);
  odezva = pulseIn(pEcho, HIGH);  // délku pulzu v mikrosekundách (us)
  vzdalenost = odezva / 58.31;    // přepočet na cm

  // načtení hodnot ze světelných čidel
  for (int i = 0; i < 4; i++) {
    Serial.print(analogRead(A0 + i));
    Serial.print(" - ");
    delay(2);
  };

  Serial.print(vzdalenost);
  Serial.println(" cm");
  delay(200);
}