commit d9b088b1be60970b33532859a4afb5b209dbb2df
Author: Leonie <hans@example.com>
Date:   Tue Jan 23 18:59:26 2024 +0100

    Initial commit

diff --git a/lego_servo.cpp b/lego_servo.cpp
new file mode 100644
index 0000000..ad756ae
--- /dev/null
+++ b/lego_servo.cpp
@@ -0,0 +1,36 @@
+#include "Arduino.h"
+#include "lego_servo.h"
+
+lego_servo::Servo::Servo(int pin_a, int pin_b) {
+    ipin_a = pin_a;
+    ipin_b = pin_b
+}
+
+void lego_servo::Servo::begin()
+{
+    pinMode(ipin_a,OUTPUT);
+    pinMode(ipin_b,OUTPUT);
+    digitalWrite(ipin_a,0);
+    digitalWrite(ipin_b,0);
+}
+
+void lego_servo::Servo::position(int pos)
+{
+    switch (pos) {
+        case 0:
+            digitalWrite(ipin_a,0);
+            digitalWrite(ipin_b,0);
+            digitalWrite(LED_BUILTIN,1);
+            break;
+        case 1:
+            digitalWrite(ipin_a,1);
+            digitalWrite(ipin_b,0);
+            digitalWrite(LED_BUILTIN,0);
+            break;
+        case 2:
+            digitalWrite(ipin_a,0);
+            digitalWrite(ipin_b,1);
+            digitalWrite(LED_BUILTIN,1);
+            break;
+    }
+}
diff --git a/lego_servo.h b/lego_servo.h
new file mode 100644
index 0000000..631c504
--- /dev/null
+++ b/lego_servo.h
@@ -0,0 +1,20 @@
+/*
+ * lego_servo a libary for contrling some lego servos
+ * Created by me :3
+ * I copyrighted your mom lmao gottem
+*/
+#ifndef lego_servo
+#define lego_servo
+
+#include "Arduino.h"
+class Servo {
+    public:
+        Servo(int pin_a, int pinb);
+        void begin();
+        void position(int pos);
+    private:
+        int ipin_a;
+        int ipin_b;
+
+};
+#endif