1 files changed, 7 insertions, 9 deletions

diff --git a/drivers/serial/vr41xx_siu.c b/drivers/serial/vr41xx_siu.c
index d61494d185cd..3f88b8e81937 100644
--- a/drivers/serial/vr41xx_siu.c
+++ b/drivers/serial/vr41xx_siu.c
@@ -821,25 +821,23 @@ static void wait_for_xmitr(struct uart_port *port)
         }
 }
 
+static void siu_console_putchar(struct uart_port *port, int ch)
+{
+        wait_for_xmitr(port);
+        siu_write(port, UART_TX, ch);
+}
+
 static void siu_console_write(struct console *con, const char *s, unsigned count)
 {
         struct uart_port *port;
         uint8_t ier;
-        unsigned i;
 
         port = &siu_uart_ports[con->index];
 
         ier = siu_read(port, UART_IER);
         siu_write(port, UART_IER, 0);
 
-        for (i = 0; i < count && *s != '\0'; i++, s++) {
-                wait_for_xmitr(port);
-                siu_write(port, UART_TX, *s);
-                if (*s == '\n') {
-                        wait_for_xmitr(port);
-                        siu_write(port, UART_TX, '\r');
-                }
-        }
+        uart_console_write(port, s, count, siu_console_putchar);
 
         wait_for_xmitr(port);
         siu_write(port, UART_IER, ier);