Initial commit

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;
+    }
+}

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