/********* Pleasedontcode.com **********

	Pleasedontcode thanks you for automatic code generation! Enjoy your code!

	- Terms and Conditions:
	You have a non-exclusive, revocable, worldwide, royalty-free license
	for personal and commercial use. Attribution is optional; modifications
	are allowed, but you're responsible for code maintenance. We're not
	liable for any loss or damage. For full terms,
	please visit pleasedontcode.com/termsandconditions.

	- Project: Scanner
	- Source Code compiled for: Arduino Uno
	- Source Code created on: 2023-11-20 11:15:39
	- Source Code generated by: AlexWind

********* Pleasedontcode.com **********/
/****** DEFINITION OF LIBRARIES *****/
#include <Arduino.h>
#include <Servo.h>
#include "Ultrasonic-distance-sensor-easyC-SOLDERED.h"

/****** SYSTEM REQUIREMENT 1 *****/
/* when something in front ultrasonic sensor senses */
/* it and then the servo motor rotates and moves to */
/* space where no obstacle is present */

/****** FUNCTION PROTOTYPES *****/
void setup(void);
void loop(void);

/***** DEFINITION OF PWM OUTPUT PINS *****/
const uint8_t servo_Servomotor_PWMSignal_PIN_D3 = 3;

/****** DEFINITION OF LIBRARIES CLASS INSTANCES*****/
Servo myservo;
Ultrasonic_Sensor hc(2, 3); // Replace with the appropriate trigger and echo pin numbers

void setup(void)
{
  // put your setup code here, to run once:
  pinMode(servo_Servomotor_PWMSignal_PIN_D3, OUTPUT);
  myservo.attach(servo_Servomotor_PWMSignal_PIN_D3);
}

void loop(void)
{
  // Check if obstacle is detected by the ultrasonic sensor
  if (hc.takeMeasure() == 0)
  {
    // Obstacle detected, rotate the servo motor to find free space
    for (int angle = 0; angle <= 180; angle += 5)
    {
      myservo.write(angle);
      delay(100);
      
      // Check if obstacle is still detected
      if (hc.takeMeasure() != 0)
      {
        // Obstacle cleared, stop rotating the servo motor
        break;
      }
    }
  }
  
  // Your code here

}