diff --git a/Mcu/f031/Src/peripherals.c b/Mcu/f031/Src/peripherals.c
index 76cd2614..152a1db5 100644
--- a/Mcu/f031/Src/peripherals.c
+++ b/Mcu/f031/Src/peripherals.c
@@ -8,7 +8,7 @@
 // PERIPHERAL SETUP
 
 #include "peripherals.h"
-
+#include "serial_telemetry.h"
 #include "ADC.h"
 #include "targets.h"
 
@@ -27,6 +27,9 @@ void initCorePeripherals(void)
     MX_TIM17_Init();
     TEN_KHZ_Timer_Init();
     UN_TIM_Init();
+#ifdef USE_SERIAL_TELEMETRY
+    telem_UART_Init();
+#endif
 }
 
 void initAfterJump()
diff --git a/Mcu/f031/Src/serial_telemetry.c b/Mcu/f031/Src/serial_telemetry.c
index a1ecfcde..2404cc02 100644
--- a/Mcu/f031/Src/serial_telemetry.c
+++ b/Mcu/f031/Src/serial_telemetry.c
@@ -78,9 +78,9 @@ void telem_UART_Init(void)
 }
 
 void send_telem_DMA()
-{ // set data length and enable channel to start transfer
+{
+    LL_DMA_DisableChannel(DMA1, LL_DMA_CHANNEL_4);
     LL_USART_SetTransferDirection(USART1, LL_USART_DIRECTION_TX);
-    //  GPIOB->OTYPER &= 0 << 6;
     LL_DMA_SetDataLength(DMA1, LL_DMA_CHANNEL_4, nbDataToTransmit);
     LL_USART_EnableDMAReq_TX(USART1);