超声波测距arduino

//引脚定义
 const int trig=8;//触发信号
 const int echo=9;//反馈信号
 
#include <LiquidCrystal.h>//显示函数头文件
LiquidCrystal lcd(12,11,5,4,3,2);

void setup() {
pinMode(echo,INPUT);    //触发端口设置为输出
pinMode(trig,OUTPUT);   //反馈端口设置为输出
lcd.begin(16,1);
lcd.print("Ready");
Serial.begin(9600);
}

void loop() {
  ultrasonic();
}

void ultrasonic(){
  long IntervalTime=0;
  while(1)
  {
    lcd.setCursor(0,1);
    digitalWrite(trig,1);//置高电平
    delayMicroseconds(15);//延迟15us
    digitalWrite(trig,0);//设为低电平
    IntervalTime=pulseIn(echo,HIGH);//用自带的函数采样反馈的高电平宽度
    float S=IntervalTime/58.00;//S是距离
    Serial.println(S);
    //lcd.clear();
    lcd.print(S);
    
    /*if(S<20)
      {
         电机右转
      }*/   
    S=0;
    IntervalTime=0;//对应的数值清零
    delay(500);
  }
}