2 x Ultrazvukový měřič vzdálenosti HC-SR04

const int trigPin = 7; 
const int echoPin = 6 ;
 
const int trig2Pin = 5; 
const int echo2Pin = 4; 
 
void setup(){
   Serial.begin(9600); 
//Inicializace Pinu
  pinMode(trigPin, OUTPUT); 
  pinMode(trig2Pin, OUTPUT);
  pinMode(echoPin, INPUT); 
  pinMode(echo2Pin, INPUT); 
 
}
 
float vzdalenost (int triger, int echo) 
{
  float delka;
  digitalWrite(triger, LOW); 
  delayMicroseconds(3); 
  digitalWrite(triger, HIGH); 
  delayMicroseconds(15); 
  digitalWrite(triger, LOW);
   // Ziskej cas v mikrosekundach, jak dlouho letela zvukova vlna plus vynasobit rychlosti zvuku 
  delka = pulseIn(echo, HIGH);
  delka  = delka  * 0.017315f;
 
  return delka;
}
 
void loop(){
 
  Serial.print(vzdalenost(trigPin,echoPin)); Serial.print(" cm    "); 
  Serial.print(vzdalenost(trig2Pin,echo2Pin)); Serial.println(" cm"); 
  delay(100);//počkej 100ms
 
}