**Servo Control** rev_01

/********* 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: **Servo Control**
    - Source Code NOT compiled for: ESP32 DevKit V1
    - Source Code created on: 2024-11-09 06:36:25

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

/****** SYSTEM REQUIREMENTS *****/
/****** SYSTEM REQUIREMENT 1 *****/
    /* smart trash bin using esp32 and ultrasonic sensor */
    /* and servo motor */
/****** END SYSTEM REQUIREMENTS *****/

/* START CODE */

/****** DEFINITION OF LIBRARIES *****/
#include <EasyButton.h> //https://github.com/evert-arias/EasyButton
#include <Ultrasonic.h> //https://github.com/ErickSimoes/Ultrasonic
#include <Servo.h>       // Include Servo library for controlling servo motors

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

/***** DEFINITION OF DIGITAL INPUT PINS *****/
const uint8_t servomotor_PushButton_PIN_D4      = 4;
const uint8_t servomotor_HC-SR04_Echo_PIN_D14       = 14;

// Define pins for HC-SR04 sensor based on your setup
const int trigPin = 19;  // Trigger pin connected to GPIO 19
const int echoPin = 18;  // Echo pin connected to GPIO 18

// Define the pin for the servo motor
const int servoPin = 27;  // Servo signal pin connected to GPIO 27

/***** DEFINITION OF DIGITAL OUTPUT PINS *****/
const uint8_t servomotor_HC-SR04_Trigger_PIN_D13        = 13;

/***** DEFINITION OF OUTPUT RAW VARIABLES *****/
/***** used to store raw data *****/
bool    servomotor_HC-SR04_Trigger_PIN_D13_rawData      = 0;

/***** DEFINITION OF OUTPUT PHYSICAL VARIABLES *****/
/***** used to store data after characteristic curve transformation *****/
float   servomotor_HC-SR04_Trigger_PIN_D13_phyData      = 0.0;

/****** DEFINITION OF LIBRARIES CLASS INSTANCES*****/
// Create a Servo object
Servo myServo;

// Create an Ultrasonic object
Ultrasonic ultrasonic(trigPin, echoPin);

// Variables to store the pulse duration and distance calculated
long duration;
float distance;

void setup(void)
{
    // put your setup code here, to run once:

    pinMode(servomotor_PushButton_PIN_D4,   INPUT_PULLUP);
    pinMode(servomotor_HC-SR04_Echo_PIN_D14,    INPUT);

    pinMode(servomotor_HC-SR04_Trigger_PIN_D13,  OUTPUT);

    // Initialize serial communication at a baud rate of 115200
    Serial.begin(115200);

    // Attach the servo on GPIO 27
    myServo.attach(servoPin);

    // Set initial servo position
    myServo.write(0);  // Start at 0 degrees (initial position)
    delay(1000); // Wait for servo to move to 0 degrees
    Serial.println("Servo initialized and set to 0 degrees");
}

void loop(void)
{
    // put your main code here, to run repeatedly:

    updateOutputs(); // Refresh output data

    // Get the distance from the ultrasonic sensor
    distance = ultrasonic.read(); // Read distance in cm

    // Check if the distance is within the sensor's range (2 cm to 400 cm)
    if (distance > 400 || distance < 2) {
        Serial.println("Out of range");
    } else {
        // Display the distance in the Serial Monitor
        Serial.print("Distance: ");
        Serial.print(distance);
        Serial.println(" cm");

        // Check if the distance is less than 10 cm (object very close)
        if (distance < 10) {
            Serial.println("Object very close, moving servo to 180 degrees");
            myServo.write(180);  // Move servo to 180 degrees
            delay(1000);          // Wait for 1 second to allow the servo to move
        }
        // Check if the distance is between 10-50 cm (object in medium range)
        else if (distance < 50) {
            Serial.println("Object in medium range, moving servo to 90 degrees");
            myServo.write(90);   // Move servo to 90 degrees
            delay(1000);          // Wait for 1 second to allow the servo to move
        }
        // If the object is far (greater than 50 cm)
        else {
            Serial.println("Object far away, moving servo to 0 degrees");
            myServo.write(0);    // Move servo to 0 degrees
            delay(1000);          // Wait for 1 second to allow the servo to move
        }
    }

    // Wait 1 second before taking the next measurement
    delay(1000);
}

void updateOutputs()
{
    digitalWrite(servomotor_HC-SR04_Trigger_PIN_D13, servomotor_HC-SR04_Trigger_PIN_D13_rawData);
}

/* END CODE */