diff --git a/Src/main.c b/Src/main.c
index e73f68b..02c7ff5 100644
--- a/Src/main.c
+++ b/Src/main.c
@@ -263,15 +263,15 @@ int main(void) {
       timeout = 0;
     #endif
 
+    // Bypass - only for testing purposes
+    // cmd1 = cmd1-500;
+    // cmd2 = cmd2-500;
+
     // ####### MOTOR ENABLING: Only if the initial input is very small (SAFETY) #######
     if (enable == 0 && (cmd1 > -50 && cmd1 < 50) && (cmd2 > -50 && cmd2 < 50)){
       enable = 1;   // enable motors
     }
 
-    // Bypass - only for testing purposes
-    // cmd2 = cmd2-500;
-    // cmd1 = 0;
-
     // ####### LOW-PASS FILTER #######
     steer = (int)(steer * (1.0f - FILTER) + cmd1 * FILTER);
     speed = (int)(speed * (1.0f - FILTER) + cmd2 * FILTER);