at91: at91-ohci: configure overcurrent pins as input GPIOs

As a new overcurrent_pin[] array has been added to the at91_usbh_data
structure, those pins must be muxed to work properly. This commit
implements this muxing for all AT91 SoCs that support the AT91 OHCI.

Signed-off-by: Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
[nicolas.ferre@atmel.com: added i variable declaration for the loop]
Signed-off-by: Nicolas Ferre <nicolas.ferre@atmel.com>

6 files changed, 42 insertions, 0 deletions

diff --git a/arch/arm/mach-at91/at91cap9_devices.c b/arch/arm/mach-at91/at91cap9_devices.c
index dba0d8d8a4bd..b46615a59355 100644
--- a/arch/arm/mach-at91/at91cap9_devices.c
+++ b/arch/arm/mach-at91/at91cap9_devices.c
@@ -80,6 +80,12 @@ void __init at91_add_device_usbh(struct at91_usbh_data *data)
                         at91_set_gpio_output(data->vbus_pin[i], 0);
         }
 
+        /* Enable overcurrent notification */
+        for (i = 0; i < data->ports; i++) {
+                if (data->overcurrent_pin[i])
+                        at91_set_gpio_input(data->overcurrent_pin[i], 1);
+        }
+
         usbh_data = *data;
         platform_device_register(&at91_usbh_device);
 }
diff --git a/arch/arm/mach-at91/at91rm9200_devices.c b/arch/arm/mach-at91/at91rm9200_devices.c
index 7227755ffec6..3f2711391a69 100644
--- a/arch/arm/mach-at91/at91rm9200_devices.c
+++ b/arch/arm/mach-at91/at91rm9200_devices.c
@@ -60,9 +60,17 @@ static struct platform_device at91rm9200_usbh_device = {
 
 void __init at91_add_device_usbh(struct at91_usbh_data *data)
 {
+        int i;
+
         if (!data)
                 return;
 
+        /* Enable overcurrent notification */
+        for (i = 0; i < data->ports; i++) {
+                if (data->overcurrent_pin[i])
+                        at91_set_gpio_input(data->overcurrent_pin[i], 1);
+        }
+
         usbh_data = *data;
         platform_device_register(&at91rm9200_usbh_device);
 }
diff --git a/arch/arm/mach-at91/at91sam9260_devices.c b/arch/arm/mach-at91/at91sam9260_devices.c
index 39f81f47b4ba..344075fbb39e 100644
--- a/arch/arm/mach-at91/at91sam9260_devices.c
+++ b/arch/arm/mach-at91/at91sam9260_devices.c
@@ -61,9 +61,17 @@ static struct platform_device at91_usbh_device = {
 
 void __init at91_add_device_usbh(struct at91_usbh_data *data)
 {
+        int i;
+
         if (!data)
                 return;
 
+        /* Enable overcurrent notification */
+        for (i = 0; i < data->ports; i++) {
+                if (data->overcurrent_pin[i])
+                        at91_set_gpio_input(data->overcurrent_pin[i], 1);
+        }
+
         usbh_data = *data;
         platform_device_register(&at91_usbh_device);
 }
diff --git a/arch/arm/mach-at91/at91sam9261_devices.c b/arch/arm/mach-at91/at91sam9261_devices.c
index 0f917928eeb7..3b8fb79d6b10 100644
--- a/arch/arm/mach-at91/at91sam9261_devices.c
+++ b/arch/arm/mach-at91/at91sam9261_devices.c
@@ -64,9 +64,17 @@ static struct platform_device at91sam9261_usbh_device = {
 
 void __init at91_add_device_usbh(struct at91_usbh_data *data)
 {
+        int i;
+
         if (!data)
                 return;
 
+        /* Enable overcurrent notification */
+        for (i = 0; i < data->ports; i++) {
+                if (data->overcurrent_pin[i])
+                        at91_set_gpio_input(data->overcurrent_pin[i], 1);
+        }
+
         usbh_data = *data;
         platform_device_register(&at91sam9261_usbh_device);
 }
diff --git a/arch/arm/mach-at91/at91sam9263_devices.c b/arch/arm/mach-at91/at91sam9263_devices.c
index a050f41fc860..d4aef76a092d 100644
--- a/arch/arm/mach-at91/at91sam9263_devices.c
+++ b/arch/arm/mach-at91/at91sam9263_devices.c
@@ -74,6 +74,12 @@ void __init at91_add_device_usbh(struct at91_usbh_data *data)
                         at91_set_gpio_output(data->vbus_pin[i], 0);
         }
 
+        /* Enable overcurrent notification */
+        for (i = 0; i < data->ports; i++) {
+                if (data->overcurrent_pin[i])
+                        at91_set_gpio_input(data->overcurrent_pin[i], 1);
+        }
+
         usbh_data = *data;
         platform_device_register(&at91_usbh_device);
 }
diff --git a/arch/arm/mach-at91/at91sam9g45_devices.c b/arch/arm/mach-at91/at91sam9g45_devices.c
index 600bffb01edb..e4a98574893d 100644
--- a/arch/arm/mach-at91/at91sam9g45_devices.c
+++ b/arch/arm/mach-at91/at91sam9g45_devices.c
@@ -124,6 +124,12 @@ void __init at91_add_device_usbh_ohci(struct at91_usbh_data *data)
                         at91_set_gpio_output(data->vbus_pin[i], 0);
         }
 
+        /* Enable overcurrent notification */
+        for (i = 0; i < data->ports; i++) {
+                if (data->overcurrent_pin[i])
+                        at91_set_gpio_input(data->overcurrent_pin[i], 1);
+        }
+
         usbh_ohci_data = *data;
         platform_device_register(&at91_usbh_ohci_device);
 }