ar71xx: add AR934x specific USB setup

[openwrt/svn-archive/archive.git] / target / linux / ar71xx / files / arch / mips / ar71xx / dev-usb.c

diff --git a/target/linux/ar71xx/files/arch/mips/ar71xx/dev-usb.c b/target/linux/ar71xx/files/arch/mips/ar71xx/dev-usb.c
index f6735713237add74b3f5b1444ef68ffb4e65e430..57c7ef292c23a397f664e25be9f88cc557a91a84 100644 (file)
--- a/target/linux/ar71xx/files/arch/mips/ar71xx/dev-usb.c
+++ b/target/linux/ar71xx/files/arch/mips/ar71xx/dev-usb.c
@@ -182,6 +182,30 @@ static void __init ar933x_usb_setup(void)
        platform_device_register(&ar71xx_ehci_device);
 }
 
+static void __init ar934x_usb_setup(void)
+{
+       u32 bootstrap;
+
+       bootstrap = ar71xx_reset_rr(AR934X_RESET_REG_BOOTSTRAP);
+       if (bootstrap & AR934X_BOOTSTRAP_USB_MODE_DEVICE)
+               return;
+
+       ar71xx_device_stop(AR934X_RESET_USBSUS_OVERRIDE);
+       udelay(1000);
+
+       ar71xx_device_start(AR934X_RESET_USB_PHY);
+       udelay(1000);
+
+       ar71xx_device_start(AR934X_RESET_USB_PHY_ANALOG);
+       udelay(1000);
+
+       ar71xx_device_start(AR934X_RESET_USB_HOST);
+       udelay(1000);
+
+       ar71xx_ehci_data.is_ar91xx = 1;
+       platform_device_register(&ar71xx_ehci_device);
+}
+
 void __init ar71xx_add_device_usb(void)
 {
        switch (ar71xx_soc) {
@@ -202,9 +226,6 @@ void __init ar71xx_add_device_usb(void)
 
        case AR71XX_SOC_AR9130:
        case AR71XX_SOC_AR9132:
-       case AR71XX_SOC_AR9341:
-       case AR71XX_SOC_AR9342:
-       case AR71XX_SOC_AR9344:
                ar91xx_usb_setup();
                break;
 
@@ -213,6 +234,12 @@ void __init ar71xx_add_device_usb(void)
                ar933x_usb_setup();
                break;
 
+       case AR71XX_SOC_AR9341:
+       case AR71XX_SOC_AR9342:
+       case AR71XX_SOC_AR9344:
+               ar934x_usb_setup();
+               break;
+
        default:
                BUG();
        }