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