diff --git a/cmake/toolchain.cmake b/cmake/toolchain.cmake
index 6f7a011..24ac005 100644
--- a/cmake/toolchain.cmake
+++ b/cmake/toolchain.cmake
@@ -91,15 +91,15 @@ set(TARGET_CFLAGS_HARDWARE "-mcpu=cortex-m23 -mfloat-abi=soft -mthumb -mthumb-in
 
 # Conditional flags
 # DEBUG
-set(CMAKE_C_FLAGS_DEBUG     "-DDEBUG=0 -O0 -g")
-set(CMAKE_CXX_FLAGS_DEBUG   "-DDEBUG=0 -O0 -g")
-set(CMAKE_ASM_FLAGS_DEBUG   "-DDEBUG=0 -O0 -g")
+#set(CMAKE_C_FLAGS_DEBUG     "-DDEBUG=0 -O0 -g")
+#set(CMAKE_CXX_FLAGS_DEBUG   "-DDEBUG=0 -O0 -g")
+#set(CMAKE_ASM_FLAGS_DEBUG   "-DDEBUG=0 -O0 -g")
 #set(CMAKE_C_FLAGS_DEBUG     "-DDEBUG=0 -O2 -g")
 #set(CMAKE_CXX_FLAGS_DEBUG   "-DDEBUG=0 -O2 -g")
 #set(CMAKE_ASM_FLAGS_DEBUG   "-DDEBUG=0 -O2 -g")
-#set(CMAKE_C_FLAGS_DEBUG     "-DDEBUG=0 -Os -g")
-#set(CMAKE_CXX_FLAGS_DEBUG   "-DDEBUG=0 -Os -g")
-#set(CMAKE_ASM_FLAGS_DEBUG   "-DDEBUG=0 -Os -g")
+set(CMAKE_C_FLAGS_DEBUG     "-DDEBUG=0 -Os -g")
+set(CMAKE_CXX_FLAGS_DEBUG   "-DDEBUG=0 -Os -g")
+set(CMAKE_ASM_FLAGS_DEBUG   "-DDEBUG=0 -Os -g")
 
 # RELEASE
 set(CMAKE_C_FLAGS_RELEASE        "-DNDEBUG -O3") #  -flto
diff --git a/src/main.c b/src/main.c
index 0874e0a..df2cb0f 100644
--- a/src/main.c
+++ b/src/main.c
@@ -6,6 +6,8 @@
 */
 #include "main.h"
 
+#include "newlib.h"
+
 volatile uint8_t g_temperature_uint8[2] = {0};
 volatile uint16_t g_capture_value;
 
diff --git a/src/usart.c b/src/usart.c
index cbaca3b..a7ee3de 100644
--- a/src/usart.c
+++ b/src/usart.c
@@ -27,10 +27,6 @@ void usart_config(void)
     usart_receive_config(USART_PHY, USART_RECEIVE_ENABLE);
     usart_transmit_config(USART_PHY, USART_TRANSMIT_ENABLE);
 
-    usart_deinit(USART_PHY);
-    usart_baudrate_set(USART_PHY, 115200U);
-    usart_receive_config(USART_PHY, USART_RECEIVE_ENABLE);
-    usart_transmit_config(USART_PHY, USART_TRANSMIT_ENABLE);
     nvic_irq_enable(USART_PHY_IRQ, 0);
     usart_interrupt_enable(USART_PHY, USART_INT_RBNE);
     // usart_interrupt_enable(USART_PHY, USART_INT_IDLE);