DevJourney · code I wrote while learning
Basic.ino
1.2 KB#include <dummy.h>
#include <ESP32Servo.h>
#define SENSOR_PIN 13
const int servoPin = 12;
Servo myServo;
int currentAngle = 0;
int step = 15;
unsigned long previousMillis = 0;
const long interval = 1000;
bool obstaclePresent = false;
void setup()
{
Serial.begin(9600);
pinMode(SENSOR_PIN, INPUT);
myServo.attach(servoPin);
myServo.write(currentAngle);
Serial.println("Servo initialized at 0 degrees");
}
void loop()
{
int state = digitalRead(SENSOR_PIN);
if (state == LOW && !obstaclePresent)
{
obstaclePresent = true;
Serial.println("Obstacle detected, starting servo movement.");
}
else if (state == HIGH && obstaclePresent)
{
obstaclePresent = false;
Serial.println("Obstacle removed, stopping servo.");
}
if (obstaclePresent)
{
unsigned long currentMillis = millis();
if (currentMillis - previousMillis >= interval)
{
previousMillis = currentMillis;
currentAngle += step;
if (currentAngle >= 180 || currentAngle <= 0)
{
step = -step;
}
myServo.write(currentAngle);
Serial.print("Servo position: ");
Serial.print(currentAngle);
Serial.println(" degrees");
}
}
}