(5/6) bcm57xx: bcm4785 incomplete reboot

[openwrt/svn-archive/archive.git] / target / linux / brcm-2.4 / files / arch / mips / bcm947xx / setup.c

diff --git a/target/linux/brcm-2.4/files/arch/mips/bcm947xx/setup.c b/target/linux/brcm-2.4/files/arch/mips/bcm947xx/setup.c
index 00c4d9054cb35157035e3454de0a002468236524..89e48236b0fc0ccbdd45642d297fdac9863cd00c 100644 (file)
--- a/target/linux/brcm-2.4/files/arch/mips/bcm947xx/setup.c
+++ b/target/linux/brcm-2.4/files/arch/mips/bcm947xx/setup.c
@@ -49,6 +49,7 @@
 #include <osl.h>
 #include <sbutils.h>
 #include <bcmnvram.h>
+#include <bcmdevs.h>
 #include <sbhndmips.h>
 #include <hndmips.h>
 #include <trxhdr.h>
@@ -89,9 +90,21 @@ bcm947xx_machine_restart(char *command)
 {
        printk("Please stand by while rebooting the system...\n");
 
+       if (sb_chip(sbh) == BCM4785_CHIP_ID)
+               MTC0(C0_BROADCOM, 4, (1 << 22));
+
        /* Set the watchdog timer to reset immediately */
        __cli();
        sb_watchdog(sbh, 1);
+
+       if (sb_chip(sbh) == BCM4785_CHIP_ID) {
+               __asm__ __volatile__(
+                       ".set\tmips3\n\t"
+                       "sync\n\t"
+                       "wait\n\t"
+                       ".set\tmips0");
+       }
+
        while (1);
 }