diff --git a/quad/xsdk_workspace/real_quad/src/hw_impl_zybo_uart.c b/quad/xsdk_workspace/real_quad/src/hw_impl_zybo_uart.c
index 940ef0abb03864de69dcc171a7cbe84d92ad6f43..807da706237c5e92d4a936ee66de3fb82eea7fa0 100644
--- a/quad/xsdk_workspace/real_quad/src/hw_impl_zybo_uart.c
+++ b/quad/xsdk_workspace/real_quad/src/hw_impl_zybo_uart.c
@@ -12,7 +12,7 @@ int zybo_uart_reset(struct UARTDriver *self) {
   struct ZyboUARTState *state = self->state;
   if (state == NULL) return -1;
   if (state->inst == NULL) return -1;
-  if (state->inst->CallBackRef == NULL) return -1;
+  if (state->queue == NULL) return -1;
 
   XUartPs *inst = state->inst;
 
diff --git a/quad/xsdk_workspace/real_quad/src/main.c b/quad/xsdk_workspace/real_quad/src/main.c
index 85ab2332ad13a372952c8d82508be08374b13209..ee7e493f4fe106f94aee9e14f955ee0f45f726bd 100644
--- a/quad/xsdk_workspace/real_quad/src/main.c
+++ b/quad/xsdk_workspace/real_quad/src/main.c
@@ -48,7 +48,7 @@ int main()
 #ifdef RUN_TESTS
   //test_zybo_mio7_led_and_system();
   //test_zybo_i2c();
-  test_zybo_i2c_imu();
+  //test_zybo_i2c_imu();
   //test_zybo_i2c_px4flow();
   //test_zybo_i2c_lidar();
   //test_zybo_i2c_all();
@@ -56,7 +56,7 @@ int main()
   //test_zybo_motors();
   //test_zybo_uart();
   //test_zybo_axi_timer();
-  //test_zybo_uart_comm();
+  test_zybo_uart_comm();
   return 0;
 #endif