From 8fa441e1f0df60cb0f9bcde76e5998398b2f4ebe Mon Sep 17 00:00:00 2001
From: Stepan Usatiuk <stepanusatiuk@gmail.com>
Date: Thu, 19 Mar 2020 12:47:51 +0300
Subject: [PATCH] remove pen hotfix now with proper power it should work

---
 Firmware/MotorControl/src/Pen.cpp | 5 +----
 1 file changed, 1 insertion(+), 4 deletions(-)

diff --git a/Firmware/MotorControl/src/Pen.cpp b/Firmware/MotorControl/src/Pen.cpp
index bc0d5df..e9d784a 100644
--- a/Firmware/MotorControl/src/Pen.cpp
+++ b/Firmware/MotorControl/src/Pen.cpp
@@ -11,7 +11,6 @@ void Pen::engage() {
         servo.attach(pin);
         servo.write(posEngaged);
         delay(200);
-        servo.detach();
     }
     engaged = true;
 }
@@ -21,7 +20,6 @@ void Pen::disengage() {
         servo.attach(pin);
         servo.write(posDisengaged);
         delay(200);
-        servo.detach();
     }
     engaged = false;
 }
@@ -29,9 +27,8 @@ void Pen::disengage() {
 void Pen::init() {
     servo.attach(pin);
     servo.write(posDisengaged);
-    delay(200);
+    delay(1000);
     engaged = false;
-    servo.detach();
 }
 
 bool Pen::getEngaged() { return engaged; }