"Ultrasonic 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: "Ultrasonic Control"
    - Source Code compiled for: Arduino Mega
    - Source Code created on: 2024-01-02 02:01:05

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

/****** SYSTEM REQUIREMENTS *****/
/****** SYSTEM REQUIREMENT 1 *****/
    /* Measure la distance à droite et à gauche */
/****** END SYSTEM REQUIREMENTS *****/

/****** DEFINITION OF LIBRARIES *****/
#include <Arduino.h>
#include <Ultrasonic.h>
#include <Servo.h>

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

/********** DEFINITION OF DIGITAL INPUT PINS **********/
const uint8_t Ultrasonic_HCSR04_Echo_PIN_RIGHT = 3;
const uint8_t Ultrasonic_HCSR04_Echo_PIN_LEFT = 4;

/********** DEFINITION OF DIGITAL OUTPUT PINS **********/
const uint8_t Ultrasonic_HCSR04_Trigger_PIN = 2;

/********** DEFINITION OF PWM OUTPUT PINS **********/
const uint8_t Servo_Servomotor_PWMSignal_PIN = 5;

/********** DEFINITION OF LIBRARY CLASS INSTANCES **********/
Ultrasonic ultrasonicRight(Ultrasonic_HCSR04_Echo_PIN_RIGHT);
Ultrasonic ultrasonicLeft(Ultrasonic_HCSR04_Echo_PIN_LEFT);
Servo servoMotor;

void setup(void)
{
  // put your setup code here, to run once:
  pinMode(Ultrasonic_HCSR04_Echo_PIN_RIGHT, INPUT);
  pinMode(Ultrasonic_HCSR04_Echo_PIN_LEFT, INPUT);
  pinMode(Ultrasonic_HCSR04_Trigger_PIN, OUTPUT);
  pinMode(Servo_Servomotor_PWMSignal_PIN, OUTPUT);

  servoMotor.attach(Servo_Servomotor_PWMSignal_PIN);

  Serial.begin(9600);
}

void loop(void)
{
  // Measure the distance to the right
  unsigned int distanceRight = ultrasonicRight.read();
  Serial.print("Distance to the right: ");
  Serial.print(distanceRight);
  Serial.println(" cm");

  // Measure the distance to the left
  unsigned int distanceLeft = ultrasonicLeft.read();
  Serial.print("Distance to the left: ");
  Serial.print(distanceLeft);
  Serial.println(" cm");

  delay(1000);
}