From: Sascha Laue <[EMAIL PROTECTED]>

Signed-off-by: Sascha Laue <[EMAIL PROTECTED]>
---
 board/lwmon5/lwmon5.c |   44 +++++++++++++++++++++++++++++++++++++++-----
 1 files changed, 39 insertions(+), 5 deletions(-)

diff --git a/board/lwmon5/lwmon5.c b/board/lwmon5/lwmon5.c
index 8975bfd..5e310f4 100644
--- a/board/lwmon5/lwmon5.c
+++ b/board/lwmon5/lwmon5.c
@@ -145,7 +145,7 @@ int misc_init_r(void)
        u32 reg;
        unsigned long usb2d0cr = 0;
        unsigned long usb2phy0cr, usb2h0cr = 0;
-       unsigned long sdr0_pfc1;
+       unsigned long sdr0_pfc1, sdr0_srst;
 
        /*
         * FLASH stuff...
@@ -207,6 +207,15 @@ int misc_init_r(void)
        /*
         * USB suff...
         */
+
+       /* Reset USB peripherie */
+       mtsdr(SDR0_SRST0, SDR0_SRST0_USB2H | SDR0_SRST0_USB2D );
+        mtsdr(SDR0_SRST1, SDR0_SRST1_USB20PHY | SDR0_SRST1_USB2HUTMI \
+               | SDR0_SRST1_USB2HPHY | SDR0_SRST1_OPBA2 \
+               | SDR0_SRST1_PLB42OPB1 | SDR0_SRST1_OPB2PLB40 );
+
+       udelay(100);    
+
        /* SDR Setting */
        mfsdr(SDR0_PFC1, sdr0_pfc1);
        mfsdr(SDR0_USB0, usb2d0cr);
@@ -234,13 +243,38 @@ int misc_init_r(void)
        mtsdr(SDR0_USB2PHY0CR, usb2phy0cr);
        mtsdr(SDR0_USB2H0CR, usb2h0cr);
 
-       /*
-        * Clear resets
-        */
+       /* the 440EPx controllers need this sequence to initiate the EHCI */
+       
+       /* deassert reset to USBPHY */
+       mfsdr(SDR0_SRST1, sdr0_srst);
+       sdr0_srst &= ~SDR0_SRST1_USB20PHY;
+       mtsdr(SDR0_SRST1, sdr0_srst);
+
        udelay (1000);
-       mtsdr(SDR0_SRST1, 0x00000000);
+
+       /* deassert reset to HOST*/
+       mfsdr(SDR0_SRST1, sdr0_srst);
+       sdr0_srst &= ~( SDR0_SRST0_USB2H );
+       mtsdr(SDR0_SRST1, sdr0_srst);
+
+       udelay(4000);
+
+       /* deassert reset to OPB1, P4OPB0, OPB2, PLB42OPB1, OPB2PLB40 cores */
+       mfsdr(SDR0_SRST1, sdr0_srst);
+       sdr0_srst &= ~( SDR0_SRST1_OPBA1        | \ 
+                       SDR0_SRST1_P4OPB0       | \
+                       SDR0_SRST1_OPBA2        | \
+                       SDR0_SRST1_PLB42OPB1    | \
+                       SDR0_SRST1_OPB2PLB40);
+       mtsdr(SDR0_SRST1, sdr0_srst);
+
        udelay (1000);
+       
+       /* deassert all other resets */
        mtsdr(SDR0_SRST0, 0x00000000);
+       mtsdr(SDR0_SRST1, 0x00000000);
+
+       udelay(1000);
 
        printf("USB:   Host(int phy) Device(ext phy)\n");
 
-- 
1.5.2.4

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot

Reply via email to