use atmega32 to control stepper motors

Signed-off-by: Stepan Usatyuk <usaatyuk@ustk.me>

Firmware/MotorControl/include/Pen.h

@@ -0,0 +1,22 @@
+#include <Servo.h>
+
+#ifndef PEN_H
+#define PEN_H
+
+class Pen {
+   private:
+    int posEngaged;
+    int posDisengaged;
+    bool engaged = true;
+    Servo servo;
+
+   public:
+    Pen(int pin, int posEngaged, int posDisengaged);
+    void engage();
+    void disengage();
+    void init();
+    bool getEngaged();
+    ~Pen();
+};
+
+#endif