📡 ماموریت ۴۰: رادار چرخان

سیم‌کشی

1. Arduino Uno (VCC5) ⟷ سروو موتور (VCC)
2. سروو موتور (GND) ⟷ Arduino Uno (GND1)
3. Arduino Uno (D11) ⟷ سروو موتور (SIG)
4. Arduino Uno (VCC5) ⟷ Ultrasonic (HC-SR04) (VCC)
5. Arduino Uno (D9) ⟷ Ultrasonic (HC-SR04) (TRIG)
6. Ultrasonic (HC-SR04) (ECHO) ⟷ Arduino Uno (D10)
7. Ultrasonic (HC-SR04) (GND) ⟷ Arduino Uno (GND2)

کد

#include <Servo.h>
Servo head;
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() {
  head.attach(11);
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
  Serial.begin(9600);
}

void loop() {
  for (int a = 15; a <= 165; a += 5) {
    head.write(a);
    delay(60);
    Serial.print("zavie:");
    Serial.print(a);
    Serial.print(" fasele:");
    Serial.println(readDistance());
  }
}