• Ultrasonik sensörün Trig pinini Arduino'nun 6. pinine, Echo pinini 7. pinine bağlamak 2.
• VCC ve GND pinlerini sırasıyla Arduino'nun 5V ve GND pinlerine bağlamak 2.
• Motor sürücü kartının IN1, IN2, IN3 ve IN4 pinlerini Arduino'nun dijital pinlerine (örneğin 8, 9, 10, 11) bağlamak 2.

#include <Servo.h>
...
void setup() {
  pinMode(ENA, OUTPUT);
  pinMode(ENB, OUTPUT);
  ...
  servo.write(0);
  delay(700);
  int distance = measureDistance();
  delay(200);
  servo.write(90);
  delay(700);
}
...
int measureDistance() {
  long duration = pulseIn(ECHO, HIGH);
  int distance = duration * 0.034 / 2;
  return (distance > 400 || distance == 0) ? 400 : distance;
}
Kopyala