diff --git a/Makefile b/Makefile
index 1052d3a..9f42be3 100644
--- a/Makefile
+++ b/Makefile
@@ -98,6 +98,11 @@ SRCS := $(sort $(notdir $(wildcard $(SRCDIR)/*.cpp)))
 OBJSDEMO += $(patsubst %.cpp, build/%.o ,$(SRCS))
 OBJS = $(filter-out $(BINARY).o, $(OBJSDEMO))
 
+ifndef USART_DEBUG
+OBJS := $(filter-out build/usart_helpers.o, $(OBJS))
+OBJSDEMO := $(filter-out build/usart_helpers.o, $(OBJSDEMO))
+endif
+
 
 INCLUDE_DIR	= $(OPENCM3_DIR)/include 
 LIB_DIR		= $(OPENCM3_DIR)/lib
diff --git a/src/usart_helpers.h b/src/usart_helpers.h
index 2a2f561..eef43fa 100644
--- a/src/usart_helpers.h
+++ b/src/usart_helpers.h
@@ -35,6 +35,7 @@ struct usart_commands{
 };
 
 
+#ifdef USART_DEBUG
 void usart_init(uint32_t usart, uint32_t baudrate);
 void usart_printf(const char *str, ...);
 void usart_vprintf(const char *str, va_list va);
@@ -42,8 +43,6 @@ void usart_fifo_send(void);
 
 void usart_call_cmd(struct usart_commands * commands);
 void usart_interrupt(void);
-
-#ifdef USART_DEBUG
 #define LOG_PRINTF(format, ...) usart_printf(format, ##__VA_ARGS__);
 #define LOG_FLUSH() usart_fifo_send()
 #else