library/Arduino/esp32_servo/esp32_servo.ino
2020-03-24 09:55:05 +01:00

46 lines
1.5 KiB
C++

#include <ESP32Servo.h>
#define SERVO_LINKS 136 // Wert um den Servo 45 Grad nach links zu drehen ... der kann je nach Servo anders sein
#define SERVO_RECHTS 45 // Wert um den Servo 45 Grad nach rechtss zu drehen ... der kann je nach Servo anders sein
#define SERVO_MITTE 90 // Wert um den Servo in die Mitte zu drehen ... der kann je nach Servo anders sein
Servo myservo[8]; // ein Servo-Objekt anlegen, um den Servo Motor steuern zu können
// 0 1 2 3 4 5 6 7
const unsigned int myservo_pin[] = {21, 32, 12, 13, 22, 19, 16, 23 };
void setup() {
Serial.begin(115200); // Serial Monitor aktivieren. Mit dem Monitor kann man sich Werte und Meldungen anzeigen lassen.
for(unsigned int serv=0;serv<=7;serv++)
{
myservo[serv].attach(myservo_pin[serv]); // dem Servo Objekt "sagen" an welchen Pin am Schaltkreis der Server angeschlossen ist
delay(200);
myservo[serv].write(SERVO_MITTE);
delay(500);
}
}
void loop() {
for(unsigned int serv = 0; serv <= 7; serv++)
{
setServo(serv, SERVO_LINKS);
setServo(serv, SERVO_RECHTS);
setServo(serv, SERVO_MITTE);
Serial.println(".");
Serial.println("---------------------------------------------------");
delay(2000);
}
}
void setServo(unsigned int serv, unsigned int angel)
{
Serial.print("Servo ");
Serial.print(serv);
Serial.print(" set to ");
Serial.print(angel);
myservo[serv].write(angel);
delay(1000);
}