Zai medregch ba servo

 

#include <Servo.h>

// constants won't change

const int TRIG_PIN  = 6;  // Arduino pin connected to Ultrasonic Sensor's TRIG pin

const int ECHO_PIN  = 7;  // Arduino pin connected to Ultrasonic Sensor's ECHO pin

const int SERVO_PIN = 10; // Arduino pin connected to Servo Motor's pin

const int DISTANCE_THRESHOLD = 50; // centimeters

int pos = 0;

Servo servo; // create servo object to control a servo

// variables will change:

float duration_us, distance_cm;

void setup() {

  Serial.begin (9600);       // initialize serial port

  pinMode(TRIG_PIN, OUTPUT); // set arduino pin to output mode

  pinMode(ECHO_PIN, INPUT);  // set arduino pin to input mode

  servo.attach(SERVO_PIN);   // attaches the servo on pin 9 to the servo object

  servo.write(0);

}

void loop() {

  // generate 10-microsecond pulse to TRIG pin

  digitalWrite(TRIG_PIN, HIGH);

  delayMicroseconds(10);

  digitalWrite(TRIG_PIN, LOW);

  // measure duration of pulse from ECHO pin

  duration_us = pulseIn(ECHO_PIN, HIGH);

  // calculate the distance

  distance_cm = 0.017 * duration_us;

  if (distance_cm < DISTANCE_THRESHOLD) {

    for (pos = 0; pos <= 180; pos += 1) { // goes from 0 degrees to 180 degrees

      // in steps of 1 degree

      servo.write(pos);              // tell servo to go to position in variable 'pos'

      delay(15);                       // waits 15ms for the servo to reach the position

    }

    for (pos = 180; pos >= 0; pos -= 1) { // goes from 180 degrees to 0 degrees

      servo.write(pos);              // tell servo to go to position in variable 'pos'

      delay(15);                       // waits 15ms for the servo to reach the position

    }

  }

  else

    servo.write(0);  // rotate servo motor to 0 degree

  // print the value to Serial Monitor

  Serial.print("distance: ");

  Serial.print(distance_cm);

  Serial.println(" cm");

  delay(500);

}

https://www.tinkercad.com/things/cILkL3mZkFb-copy-of-ultrasonic-and-servo/editel?tenant=circuits