From d19c166ef933878a54bf886086659996a6cd4ae8 Mon Sep 17 00:00:00 2001
From: Stepan Usatiuk <stepanusatiuk@gmail.com>
Date: Thu, 19 Mar 2020 14:35:04 +0300
Subject: [PATCH] fix servo not disengaging

---
 Firmware/MotorControl/src/Pen.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/Firmware/MotorControl/src/Pen.cpp b/Firmware/MotorControl/src/Pen.cpp
index 3d81dcb..bf9c5c0 100644
--- a/Firmware/MotorControl/src/Pen.cpp
+++ b/Firmware/MotorControl/src/Pen.cpp
@@ -18,7 +18,7 @@ void Pen::engage() {
 
 void Pen::disengage() {
     if (engaged) {
-        for (int i = posEngaged; i > posDisengaged; i++) {
+        for (int i = posEngaged; i < posDisengaged; i++) {
             servo.write(i);
             delay(5);
         }