1 files changed, 26 insertions, 0 deletions
diff --git a/servo/servo.ino b/servo/servo.ino
new file mode 100644
index 0000000..b9e3b2f
--- /dev/null
+++ b/servo/servo.ino
@@ -0,0 +1,26 @@
+#include "ESP32Servo.h"
+
+Servo base;
+Servo shoulder;
+Servo elbow;
+
+void setup() {
+  base.attach(15);
+  shoulder.attach(2);
+  elbow.attach(4);
+}
+
+void loop() {
+  for (int pos = 0; pos <= 180; pos += 1) {
+    base.write(pos);
+    shoulder.write(pos);
+    elbow.write(pos);
+    delay(15);
+  }
+  for (int pos = 180; pos >= 0; pos -= 1) {
+    base.write(pos);
+    shoulder.write(pos);
+    elbow.write(pos);
+    delay(15);
+  }
+}