diff --git a/UAV-ControlSystem/src/main.c b/UAV-ControlSystem/src/main.c
index c5a75e8..fb73cea 100644
--- a/UAV-ControlSystem/src/main.c
+++ b/UAV-ControlSystem/src/main.c
@@ -62,18 +62,7 @@ void init_system()
 	cliInit(USART3);
 
 	//init sbus, using USART1
-//	sbus_init();
-
-	arduinoCom_init(USART1);
-
-	while(1)
-	{
-		HAL_Delay(1000);
-		if(arduino_frame_available())
-			arduino_read();
-		arduino_send_sensor_values();
-	}
-
+	sbus_init();
 
 
 #ifdef USE_LEDS