1 files changed, 14 insertions, 11 deletions

diff --git a/arch/arm/kernel/debug.S b/arch/arm/kernel/debug.S
index 423f4432586d..611ded664d61 100644
--- a/arch/arm/kernel/debug.S
+++ b/arch/arm/kernel/debug.S
@@ -85,25 +85,28 @@ hexbuf_rel:	.long	hexbuf_addr - .
 
 ENTRY(printascii)
                 addruart_current r3, r1, r2
-                b       2f
-1:              waituart r2, r3
-                senduart r1, r3
-                busyuart r2, r3
-                teq     r1, #'\n'
-                moveq   r1, #'\r'
-                beq     1b
-2:              teq     r0, #0
+1:              teq     r0, #0
                 ldrneb  r1, [r0], #1
                 teqne   r1, #0
-                bne     1b
-                ret     lr
+                reteq   lr
+2:              teq     r1, #'\n'
+                bne     3f
+                mov     r1, #'\r'
+                waituart r2, r3
+                senduart r1, r3
+                busyuart r2, r3
+                mov     r1, #'\n'
+3:              waituart r2, r3
+                senduart r1, r3
+                busyuart r2, r3
+                b       1b
 ENDPROC(printascii)
 
 ENTRY(printch)
                 addruart_current r3, r1, r2
                 mov     r1, r0
                 mov     r0, #0
-                b       1b
+                b       2b
 ENDPROC(printch)
 
 #ifdef CONFIG_MMU