Vesim Wiki

Toto je starší verze dokumentu!

---

const int trigPin = 7; 
const int echoPin = 6 ;
 
const int trig2Pin = 5; // Trig pin je pripojeny na digitalni pin 5
const int echo2Pin = 4; // Echo pin je pripojeny na digitalni pin 4
 
 
void setup(){
   // initialize serial communications at 9600 bps:
   Serial.begin(9600);
    // Na digitalni pin Trig budeme posilat signal
  pinMode(trigPin, OUTPUT); 
  pinMode(trig2Pin, OUTPUT);
    // Na digitalnim pinu Echo budeme poslouchat
  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
  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(2);//počkej 500ms
}