2 files changed, 28 insertions, 8 deletions

diff --git a/arch/powerpc/kernel/misc_32.S b/arch/powerpc/kernel/misc_32.S
index f6d84a75ed26..624a983a9676 100644
--- a/arch/powerpc/kernel/misc_32.S
+++ b/arch/powerpc/kernel/misc_32.S
@@ -27,14 +27,6 @@
 
         .text
 
-        .align  5
-_GLOBAL(__delay)
-        cmpwi   0,r3,0
-        mtctr   r3
-        beqlr
-1:      bdnz    1b
-        blr
-
 /*
  * This returns the high 64 bits of the product of two 64-bit numbers.
  */
diff --git a/arch/powerpc/kernel/time.c b/arch/powerpc/kernel/time.c
index 070b4b458aaf..de8479769bb7 100644
--- a/arch/powerpc/kernel/time.c
+++ b/arch/powerpc/kernel/time.c
@@ -130,6 +130,34 @@ unsigned long tb_last_stamp;
  */
 DEFINE_PER_CPU(unsigned long, last_jiffy);
 
+void __delay(unsigned long loops)
+{
+        unsigned long start;
+        int diff;
+
+        if (__USE_RTC()) {
+                start = get_rtcl();
+                do {
+                        /* the RTCL register wraps at 1000000000 */
+                        diff = get_rtcl() - start;
+                        if (diff < 0)
+                                diff += 1000000000;
+                } while (diff < loops);
+        } else {
+                start = get_tbl();
+                while (get_tbl() - start < loops)
+                        HMT_low();
+                HMT_medium();
+        }
+}
+EXPORT_SYMBOL(__delay);
+
+void udelay(unsigned long usecs)
+{
+        __delay(tb_ticks_per_usec * usecs);
+}
+EXPORT_SYMBOL(udelay);
+
 static __inline__ void timer_check_rtc(void)
 {
         /*