c_cpp arduino_sonic_sensor.ino

Posted 2021-05-14

// 出力ピン
int output = 5;
// インプットピン
int input = 9;

void setup() 
{
  Serial.begin(9600);
  pinMode(output, OUTPUT);
  pinMode(input, INPUT);
}

void loop() 
{
  // リセット
  digitalWrite(output, LOW); 
  delayMicroseconds(2);
  
  // 超音波を100μ秒照射
  digitalWrite(output, HIGH); 
  delayMicroseconds(100);
  // 超音波を照射停止
  digitalWrite(output, LOW);
  
  // duration : エコーが返って来た時間(マイクロ秒)
  float duration = pulseIn(input, HIGH);
  
  // ターゲットまでの距離を算出(ミリメートル)
  unsigned int distance = int(duration * 340 * 0.5 * 0.001);

  Serial.println(duration);
  Serial.println(distance);
}