diff --git a/Control/firmware/uart_echo/main.c b/Control/firmware/uart_echo/main.c
index 8e7ddf6..d3d1e0a 100755
--- a/Control/firmware/uart_echo/main.c
+++ b/Control/firmware/uart_echo/main.c
@@ -93,7 +93,7 @@ int main(void)
 	State_t state = StateNormal;
 	State_t state_next = StateNormal;
 	
-	fifo_init(&messageFifo, 16, sizeof(Msg_t), "Fifo");
+	fifo_init(&messageFifo, 8, sizeof(Msg_t), "Fifo");
 	
     /* Replace with your application code */
 	uart_init(&messageFifo, BAUD_PRESCALE);
@@ -227,7 +227,7 @@ int main(void)
 						{
 							PRINT("Timeout!\n");
 							setPower(PowerLow);
-//							setSwitch(SwitchOff);
+							setSwitch(SwitchOff);
 							state_next = StateError;
 						}
 						break;