c_cpp HC-SR04

Posted 2021-05-14

int Trig = A5;
int Echo = A4;
float cm;

void setup()
{
  Serial.begin(9600);
  pinMode(Trig,OUTPUT);
  pinMode(Echo,INPUT);
}

int Distance_measure()
{
  digitalWrite(Trig,LOW);
  delayMicroseconds(2);
  digitalWrite(Trig,HIGH);
  delayMicroseconds(10);
  digitalWrite(Trig,LOW);
  cm = pulseIn(Echo,HIGH)/58.15;
  cm = (int(cm * 100.0)) / 100.0; 
  Serial.print("Distance:");
  Serial.print(cm);
  Serial.println("cm");
  delay(500);
}

void loop()
{
  delay(500);
  Distance_measure();
}