2 files changed, 19 insertions, 9 deletions

diff --git a/arch/powerpc/platforms/83xx/mpc83xx.h b/arch/powerpc/platforms/83xx/mpc83xx.h
index 393dfecdbf53..2a7cbabb410a 100644
--- a/arch/powerpc/platforms/83xx/mpc83xx.h
+++ b/arch/powerpc/platforms/83xx/mpc83xx.h
@@ -26,6 +26,8 @@
 #define MPC834X_SICRL_USB1         0x20000000
 #define MPC831X_SICRL_USB_MASK     0x00000c00
 #define MPC831X_SICRL_USB_ULPI     0x00000800
+#define MPC8315_SICRL_USB_MASK     0x000000fc
+#define MPC8315_SICRL_USB_ULPI     0x00000054
 #define MPC837X_SICRL_USB_MASK     0xf0000000
 #define MPC837X_SICRL_USB_ULPI     0x50000000
 
@@ -34,6 +36,8 @@
 #define MPC834X_SICRH_USB_UTMI     0x00020000
 #define MPC831X_SICRH_USB_MASK     0x000000e0
 #define MPC831X_SICRH_USB_ULPI     0x000000a0
+#define MPC8315_SICRH_USB_MASK     0x0000ff00
+#define MPC8315_SICRH_USB_ULPI     0x00000000
 
 /* USB Control Register */
 #define FSL_USB2_CONTROL_OFFS      0x500
diff --git a/arch/powerpc/platforms/83xx/usb.c b/arch/powerpc/platforms/83xx/usb.c
index 64bcf0a33c71..cc99c280aad9 100644
--- a/arch/powerpc/platforms/83xx/usb.c
+++ b/arch/powerpc/platforms/83xx/usb.c
@@ -137,15 +137,21 @@ int mpc831x_usb_cfg(void)
 
         /* Configure pin mux for ULPI.  There is no pin mux for UTMI */
         if (prop && !strcmp(prop, "ulpi")) {
-                temp = in_be32(immap + MPC83XX_SICRL_OFFS);
-                temp &= ~MPC831X_SICRL_USB_MASK;
-                temp |= MPC831X_SICRL_USB_ULPI;
-                out_be32(immap + MPC83XX_SICRL_OFFS, temp);
-
-                temp = in_be32(immap + MPC83XX_SICRH_OFFS);
-                temp &= ~MPC831X_SICRH_USB_MASK;
-                temp |= MPC831X_SICRH_USB_ULPI;
-                out_be32(immap + MPC83XX_SICRH_OFFS, temp);
+                if (of_device_is_compatible(immr_node, "fsl,mpc8315-immr")) {
+                        clrsetbits_be32(immap + MPC83XX_SICRL_OFFS,
+                                        MPC8315_SICRL_USB_MASK,
+                                        MPC8315_SICRL_USB_ULPI);
+                        clrsetbits_be32(immap + MPC83XX_SICRH_OFFS,
+                                        MPC8315_SICRH_USB_MASK,
+                                        MPC8315_SICRH_USB_ULPI);
+                } else {
+                        clrsetbits_be32(immap + MPC83XX_SICRL_OFFS,
+                                        MPC831X_SICRL_USB_MASK,
+                                        MPC831X_SICRL_USB_ULPI);
+                        clrsetbits_be32(immap + MPC83XX_SICRH_OFFS,
+                                        MPC831X_SICRH_USB_MASK,
+                                        MPC831X_SICRH_USB_ULPI);
+                }
         }
 
         iounmap(immap);