📏 ماموریت ۲۲: فاصله‌سنج

سیم‌کشی

1. Arduino Uno (VCC5) ⟷ Ultrasonic (HC-SR04) (VCC)
2. Arduino Uno (D9) ⟷ Ultrasonic (HC-SR04) (TRIG)
3. Ultrasonic (HC-SR04) (ECHO) ⟷ Arduino Uno (D10)
4. Ultrasonic (HC-SR04) (GND) ⟷ Arduino Uno (GND1)

کد

const int trig = 9, echo = 10;

long readDistance() {
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);
  long d = pulseIn(echo, HIGH, 30000);
  return d == 0 ? 400 : d / 58;
}

void setup() {
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
  Serial.begin(9600);
}

void loop() {
  Serial.print("fasele:");
  Serial.println(readDistance());
  delay(200);
}