38 lines
1.1 KiB
C++
38 lines
1.1 KiB
C++
#include <ESP32Servo.h>
|
|
|
|
Servo myservo; // create servo object to control a servo
|
|
int servoPin = 18;
|
|
|
|
void closeCircuitAndOpen(int closeTime=400)
|
|
{
|
|
int pos = 0;
|
|
for(pos = 0; pos <= 180; pos += 1) { // goes from 0 degrees to 180 degrees
|
|
// in steps of 1 degree
|
|
myservo.write(pos); // tell servo to go to position in variable 'pos'
|
|
delay(15); // waits 15ms for the servo to reach the position
|
|
}
|
|
delay(closeTime);
|
|
for (pos = 180; pos >= 0; pos -= 1) { // goes from 180 degrees to 0 degrees
|
|
myservo.write(pos); // tell servo to go to position in variable 'pos'
|
|
delay(15); // waits 15ms for the servo to reach the position
|
|
}
|
|
}
|
|
|
|
void setup()
|
|
{
|
|
// Allow allocation of all timers
|
|
ESP32PWM::allocateTimer(0);
|
|
ESP32PWM::allocateTimer(1);
|
|
ESP32PWM::allocateTimer(2);
|
|
ESP32PWM::allocateTimer(3);
|
|
myservo.setPeriodHertz(50); // standard 50 hz servo
|
|
myservo.attach(servoPin, 1000, 2000); // attaches the servo on pin 18 to the servo object
|
|
myservo.write(0);delay(2500); // position to initial suitable position
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
closeCircuitAndOpen();
|
|
delay(5000);
|
|
}
|
|
|