+++ /dev/null
-
-
-       .text
-
-       .global icedcc_putc
-
-icedcc_putc:
-       mov     r2, #0x4000000
-1:
-       subs    r2, r2, #1
-       movlt   pc, r14
-       mrc     p14, 0, r1, c0, c0, 0
-       tst     r1, #2
-       bne     1b
-
-       mcr     p14, 0, r0, c1, c0, 0
-       mov     pc, r14
 
 #include <asm/arch/uncompress.h>
 
 #ifdef CONFIG_DEBUG_ICEDCC
-extern void icedcc_putc(int ch);
+static void icedcc_putc(int ch)
+{
+       int status, i = 0x4000000;
+
+       do {
+               if (--i < 0)
+                       return;
+
+               asm("mrc p14, 0, %0, c0, c0, 0" : "=r" (status));
+       } while (status & 2);
+
+       asm("mcr p15, 0, %0, c1, c0, 0" : : "r" (ch));
+}
+
 #define putc(ch)       icedcc_putc(ch)
 #define flush()        do { } while (0)
 #endif