diff --git a/quad/sw/modular_quad_pid/src/initialize_components.c b/quad/sw/modular_quad_pid/src/initialize_components.c
index c83ba76f0f1f9430ff586c06814cbfa0167c683c..c548d26d2151f6923fc91421211a2f938f3e9a4b 100644
--- a/quad/sw/modular_quad_pid/src/initialize_components.c
+++ b/quad/sw/modular_quad_pid/src/initialize_components.c
@@ -8,7 +8,7 @@
 #include "initialize_components.h"
 #include "communication.h"
 
-#define BENCH_TEST
+//#define BENCH_TEST
 
 extern int Xil_AssertWait;
 
diff --git a/quad/sw/modular_quad_pid/src/main.c b/quad/sw/modular_quad_pid/src/main.c
index 497d334bc4caba4d10f78363698fa3329de36451..cfc3076a86995621278deffdc99b40060c92e447 100644
--- a/quad/sw/modular_quad_pid/src/main.c
+++ b/quad/sw/modular_quad_pid/src/main.c
@@ -16,7 +16,7 @@
 #include "send_actuator_commands.h"
 #include "update_gui.h"
 
-#define BENCH_TEST
+//#define BENCH_TEST
 //#define UART_BENCHMARK
 
 int main()