1 files changed, 25 insertions, 0 deletions

diff --git a/arch/powerpc/kernel/head_32.S b/arch/powerpc/kernel/head_32.S
index 829c3fe7c5a2..e025e89fe93e 100644
--- a/arch/powerpc/kernel/head_32.S
+++ b/arch/powerpc/kernel/head_32.S
@@ -164,6 +164,9 @@ __after_mmu_off:
 #ifdef CONFIG_PPC_EARLY_DEBUG_CPM
         bl      setup_cpm_bat
 #endif
+#ifdef CONFIG_PPC_EARLY_DEBUG_USBGECKO
+        bl      setup_usbgecko_bat
+#endif
 
 /*
  * Call setup_cpu for CPU 0 and initialize 6xx Idle
@@ -1203,6 +1206,28 @@ setup_cpm_bat:
         blr
 #endif
 
+#ifdef CONFIG_PPC_EARLY_DEBUG_USBGECKO
+setup_usbgecko_bat:
+        /* prepare a BAT for early io */
+#if defined(CONFIG_GAMECUBE)
+        lis     r8, 0x0c00
+#elif defined(CONFIG_WII)
+        lis     r8, 0x0d00
+#else
+#error Invalid platform for USB Gecko based early debugging.
+#endif
+        /*
+         * The virtual address used must match the virtual address
+         * associated to the fixmap entry FIX_EARLY_DEBUG_BASE.
+         */
+        lis     r11, 0xfffe     /* top 128K */
+        ori     r8, r8, 0x002a  /* uncached, guarded ,rw */
+        ori     r11, r11, 0x2   /* 128K, Vs=1, Vp=0 */
+        mtspr   SPRN_DBAT1L, r8
+        mtspr   SPRN_DBAT1U, r11
+        blr
+#endif
+
 #ifdef CONFIG_8260
 /* Jump into the system reset for the rom.
  * We first disable the MMU, and then jump to the ROM reset address.