Add more debug messages

src/main.c

@@ -34,12 +34,19 @@ int main(void)
 void Enable(void)
 {
 	USART_Printf("[CORE] Parsed 'CMD_RUN' token.\r\n");
+	if (running == true) {
+		USART_Printf("[CORE] Error: Already running.\r\n");
+	}
+
 	running = true;
 }
 
 void Disable(void)
 {
 	USART_Printf("[CORE] Parsed 'CMD_STOP' token.\r\n");
+	if (running == false) {
+		USART_Printf("[CORE] Error: Already stopped.\r\n");
+	}
 	running = false;
 }