超聲波程式碼

int trigPin = 12;                  //Trig Pin

int echoPin = 11;                  //Echo Pin

float inverse_sonic_speed = 29.1;          //(1/sonic speed)

long duration, inches;

float cm;

void setup() {

  Serial.begin (9600);             // Serial Port begin

  pinMode(trigPin, OUTPUT);        // 定義輸入及輸出 

  pinMode(echoPin, INPUT);

}

void loop()

{

  digitalWrite(trigPin, LOW);

  delayMicroseconds(5);

  digitalWrite(trigPin, HIGH);     // 給 Trig 高電位，持續 10微秒

  delay(10);

  digitalWrite(trigPin, LOW);

  pinMode(echoPin, INPUT);             // 讀取 echo 的電位

  duration = pulseIn(echoPin,HIGH);   // 收到高電位時的時間(微秒)

  cm = (duration/2) / inverse_sonic_speed;         // 將時間換算成距離 cm, 29.1 (1/sonic speed)

  Serial.println(cm);

  delay(250);

}