From: Gregory Bean <[email protected]>

Reorganize gpiomux initialization as follows:
- remove the global static gpiomux configuration table;
- remove the universal initcall from gpiomux.c;
- add a public function, msm_gpiomux_init, which installs
  a provided gpiomux config table and runs the code
  previously run by the universal init;
- Add initcalls in each of the board-specific gpiomux files.

This decentralization of gpiomux init improves its flexibility
by allowing board-specific runtime code to select and/or
assemble the correct gpiomux-config table and send it to the
gpiomux framework for initialization. Rather than having a single
static array which must meet all needs.

Change-Id: Id34e7a5471c1f5d415d6524729e4652a0798f49a
Signed-off-by: Rohit Vaswani <[email protected]>
---
v2: Re-send

 arch/arm/mach-msm/board-msm7x27.c |   19 ++++++++++
 arch/arm/mach-msm/board-msm7x30.c |   49 ++++++++++++++++++--------
 arch/arm/mach-msm/board-msm8x60.c |   18 +++++++++-
 arch/arm/mach-msm/board-qsd8x50.c |   33 ++++++++++++++----
 arch/arm/mach-msm/gpiomux-v1.h    |    8 ----
 arch/arm/mach-msm/gpiomux-v2.h    |    2 -
 arch/arm/mach-msm/gpiomux.c       |   68 +++++++++++++++++++++++++++++-------
 arch/arm/mach-msm/gpiomux.h       |   28 ++++++++++-----
 8 files changed, 169 insertions(+), 56 deletions(-)

diff --git a/arch/arm/mach-msm/board-msm7x27.c 
b/arch/arm/mach-msm/board-msm7x27.c
index 16d7580..10affe5 100644
--- a/arch/arm/mach-msm/board-msm7x27.c
+++ b/arch/arm/mach-msm/board-msm7x27.c
@@ -45,6 +45,8 @@
 #include "socinfo.h"
 #include "clock.h"
 
+struct msm_gpiomux_config msm7x27_gpiomux_configs[NR_GPIO_IRQS] __initdata = 
{};
+
 static struct resource smc91x_resources[] = {
        [0] = {
                .start  = 0x9C004300,
@@ -75,6 +77,21 @@ static struct platform_device *devices[] __initdata = {
 
 extern struct sys_timer msm_timer;
 
+static int __init gpiomux_init(void)
+{
+       int rc;
+
+       rc = msm_gpiomux_init(NR_GPIO_IRQS);
+       if (rc) {
+               printk(KERN_ERR "msm_gpiomux_init failed - %n", rc);
+               return rc;
+       }
+
+       msm_gpiomux_install(msm7x27_gpiomux_configs,
+                       ARRAY_SIZE(msm7x27_gpiomux_configs));
+       return 0;
+}
+
 static void __init msm7x2x_init_irq(void)
 {
        msm_init_irq();
@@ -85,6 +102,8 @@ static void __init msm7x2x_init(void)
        if (socinfo_init() < 0)
                BUG();
 
+       gpiomux_init();
+
        if (machine_is_msm7x25_ffa() || machine_is_msm7x27_ffa()) {
                smc91x_resources[0].start = 0x98000300;
                smc91x_resources[0].end = 0x980003ff;
diff --git a/arch/arm/mach-msm/board-msm7x30.c 
b/arch/arm/mach-msm/board-msm7x30.c
index dc9fac1..59b91de 100644
--- a/arch/arm/mach-msm/board-msm7x30.c
+++ b/arch/arm/mach-msm/board-msm7x30.c
@@ -39,6 +39,9 @@
 #include "gpiomux.h"
 #include "proc_comm.h"
 
+#define UART2_SUSPENDED (GPIOMUX_DRV_2MA | GPIOMUX_PULL_DOWN |\
+                       GPIOMUX_FUNC_2 | GPIOMUX_VALID)
+
 extern struct sys_timer msm_timer;
 
 static int hsusb_phy_init_seq[] = {
@@ -53,25 +56,23 @@ static struct msm_otg_platform_data msm_otg_pdata = {
        .otg_control            = OTG_PHY_CONTROL,
 };
 
-struct msm_gpiomux_config msm_gpiomux_configs[GPIOMUX_NGPIOS] = {
-#ifdef CONFIG_SERIAL_MSM_CONSOLE
-       [49] = { /* UART2 RFR */
-               .suspended = GPIOMUX_DRV_2MA | GPIOMUX_PULL_DOWN |
-                            GPIOMUX_FUNC_2 | GPIOMUX_VALID,
+struct msm_gpiomux_config msm7x30_uart2_configs[] __initdata = {
+       {
+               .gpio = 49, /* UART2 RFR */
+               .suspended = UART2_SUSPENDED,
        },
-       [50] = { /* UART2 CTS */
-               .suspended = GPIOMUX_DRV_2MA | GPIOMUX_PULL_DOWN |
-                            GPIOMUX_FUNC_2 | GPIOMUX_VALID,
+       {
+               .gpio = 50, /* UART2 CTS */
+               .suspended = UART2_SUSPENDED,
        },
-       [51] = { /* UART2 RX */
-               .suspended = GPIOMUX_DRV_2MA | GPIOMUX_PULL_DOWN |
-                            GPIOMUX_FUNC_2 | GPIOMUX_VALID,
+       {
+               .gpio = 51, /* UART2 RX */
+               .suspended = UART2_SUSPENDED,
        },
-       [52] = { /* UART2 TX */
-               .suspended = GPIOMUX_DRV_2MA | GPIOMUX_PULL_DOWN |
-                            GPIOMUX_FUNC_2 | GPIOMUX_VALID,
+       {
+               .gpio = 52, /* UART2 TX */
+               .suspended = UART2_SUSPENDED,
        },
-#endif
 };
 
 static struct platform_device *devices[] __initdata = {
@@ -84,6 +85,22 @@ static struct platform_device *devices[] __initdata = {
        &msm_device_hsusb_host,
 };
 
+static int __init gpiomux_init(void)
+{
+       int rc;
+
+       rc = msm_gpiomux_init(NR_GPIO_IRQS);
+       if (rc) {
+               printk(KERN_ERR "msm_gpiomux_init failed - %d\n", rc);
+               return rc;
+       }
+
+       msm_gpiomux_install(msm7x30_uart2_configs,
+                       ARRAY_SIZE(msm7x30_uart2_configs));
+       return 0;
+
+}
+
 static void __init msm7x30_init_irq(void)
 {
        msm_init_irq();
@@ -95,6 +112,8 @@ static void __init msm7x30_init(void)
        msm_device_hsusb.dev.parent = &msm_device_otg.dev;
        msm_device_hsusb_host.dev.parent = &msm_device_otg.dev;
 
+       gpiomux_init();
+
        platform_add_devices(devices, ARRAY_SIZE(devices));
 }
 
diff --git a/arch/arm/mach-msm/board-msm8x60.c 
b/arch/arm/mach-msm/board-msm8x60.c
index 6c0b868..de4d8d1 100644
--- a/arch/arm/mach-msm/board-msm8x60.c
+++ b/arch/arm/mach-msm/board-msm8x60.c
@@ -29,8 +29,23 @@
 #include <mach/msm_iomap.h>
 #include "gpiomux.h"
 
-struct msm_gpiomux_config msm_gpiomux_configs[GPIOMUX_NGPIOS] = {};
+struct msm_gpiomux_config msm8x60_gpiomux_configs[NR_GPIO_IRQS] __initdata = 
{};
 
+static int __init gpiomux_init(void)
+{
+       int rc;
+
+       rc = msm_gpiomux_init(NR_GPIO_IRQS);
+       if (rc) {
+               printk(KERN_ERR "msm_gpiomux_init failed %d\n", rc);
+               return rc;
+       }
+
+       msm_gpiomux_install(msm8x60_gpiomux_configs,
+                       ARRAY_SIZE(msm8x60_gpiomux_configs));
+
+       return 0;
+}
 
 static void __init msm8x60_map_io(void)
 {
@@ -65,6 +80,7 @@ static void __init msm8x60_init_irq(void)
 
 static void __init msm8x60_init(void)
 {
+       gpiomux_init();
 }
 
 MACHINE_START(MSM8X60_RUMI3, "QCT MSM8X60 RUMI3")
diff --git a/arch/arm/mach-msm/board-qsd8x50.c 
b/arch/arm/mach-msm/board-qsd8x50.c
index b63b7c4..33ab1fe 100644
--- a/arch/arm/mach-msm/board-qsd8x50.c
+++ b/arch/arm/mach-msm/board-qsd8x50.c
@@ -38,16 +38,19 @@
 #include "devices.h"
 #include "gpiomux.h"
 
+#define UART3_SUSPENDED (GPIOMUX_DRV_2MA | GPIOMUX_PULL_DOWN |\
+                       GPIOMUX_FUNC_1 | GPIOMUX_VALID)
+
 extern struct sys_timer msm_timer;
 
-struct msm_gpiomux_config msm_gpiomux_configs[GPIOMUX_NGPIOS] = {
-       [86] = { /* UART3 RX */
-               .suspended = GPIOMUX_DRV_2MA | GPIOMUX_PULL_DOWN |
-                            GPIOMUX_FUNC_1 | GPIOMUX_VALID,
+struct msm_gpiomux_config qsd8x50_uart3_configs[] __initdata = {
+       {
+               .gpio = 86, /* UART3 RX */
+               .suspended = UART3_SUSPENDED,
        },
-       [87] = { /* UART3 TX */
-               .suspended = GPIOMUX_DRV_2MA | GPIOMUX_PULL_DOWN |
-                            GPIOMUX_FUNC_1 | GPIOMUX_VALID,
+       {
+               .gpio = 87, /* UART3 TX */
+               .suspended = UART3_SUSPENDED,
        },
 };
 
@@ -169,6 +172,21 @@ static struct msm_mmc_platform_data qsd8x50_sdc1_data = {
        .gpio_data = &sdc1_gpio,
 };
 
+static int __init gpiomux_init(void)
+{
+       int rc;
+
+       rc = msm_gpiomux_init(NR_GPIO_IRQS);
+       if (rc) {
+               printk(KERN_ERR "msm_gpiomux_init failed - %d\n", rc);
+               return rc;
+       }
+
+       msm_gpiomux_install(qsd8x50_uart3_configs,
+                       ARRAY_SIZE(qsd8x50_uart3_configs));
+       return 0;
+}
+
 static void __init qsd8x50_init_mmc(void)
 {
        if (machine_is_qsd8x50_ffa() || machine_is_qsd8x50a_ffa())
@@ -202,6 +220,7 @@ static void __init qsd8x50_init(void)
        msm_device_otg.dev.platform_data = &msm_otg_pdata;
        msm_device_hsusb.dev.parent = &msm_device_otg.dev;
        msm_device_hsusb_host.dev.parent = &msm_device_otg.dev;
+       gpiomux_init();
        platform_add_devices(devices, ARRAY_SIZE(devices));
        qsd8x50_init_mmc();
 }
diff --git a/arch/arm/mach-msm/gpiomux-v1.h b/arch/arm/mach-msm/gpiomux-v1.h
index 71d86fe..96ad5fa 100644
--- a/arch/arm/mach-msm/gpiomux-v1.h
+++ b/arch/arm/mach-msm/gpiomux-v1.h
@@ -17,14 +17,6 @@
 #ifndef __ARCH_ARM_MACH_MSM_GPIOMUX_V1_H
 #define __ARCH_ARM_MACH_MSM_GPIOMUX_V1_H
 
-#if defined(CONFIG_ARCH_MSM7X30)
-#define GPIOMUX_NGPIOS 182
-#elif defined(CONFIG_ARCH_QSD8X50)
-#define GPIOMUX_NGPIOS 165
-#else
-#define GPIOMUX_NGPIOS 133
-#endif
-
 typedef u32 gpiomux_config_t;
 
 enum {
diff --git a/arch/arm/mach-msm/gpiomux-v2.h b/arch/arm/mach-msm/gpiomux-v2.h
index 3bf10e7..a7dec1ea 100644
--- a/arch/arm/mach-msm/gpiomux-v2.h
+++ b/arch/arm/mach-msm/gpiomux-v2.h
@@ -17,8 +17,6 @@
 #ifndef __ARCH_ARM_MACH_MSM_GPIOMUX_V2_H
 #define __ARCH_ARM_MACH_MSM_GPIOMUX_V2_H
 
-#define GPIOMUX_NGPIOS 173
-
 typedef u16 gpiomux_config_t;
 
 enum {
diff --git a/arch/arm/mach-msm/gpiomux.c b/arch/arm/mach-msm/gpiomux.c
index 53af21a..9ef9864 100644
--- a/arch/arm/mach-msm/gpiomux.c
+++ b/arch/arm/mach-msm/gpiomux.c
@@ -15,20 +15,31 @@
  * 02110-1301, USA.
  */
 #include <linux/module.h>
+#include <linux/slab.h>
 #include <linux/spinlock.h>
 #include "gpiomux.h"
 
+struct msm_gpiomux_rec {
+       gpiomux_config_t active;
+       gpiomux_config_t suspended;
+       int              ref;
+};
 static DEFINE_SPINLOCK(gpiomux_lock);
+static struct msm_gpiomux_rec *msm_gpiomux_recs;
+static unsigned msm_gpiomux_ngpio;
 
 int msm_gpiomux_write(unsigned gpio,
                      gpiomux_config_t active,
                      gpiomux_config_t suspended)
 {
-       struct msm_gpiomux_config *cfg = msm_gpiomux_configs + gpio;
+       struct msm_gpiomux_rec *cfg = msm_gpiomux_recs + gpio;
        unsigned long irq_flags;
        gpiomux_config_t setting;
 
-       if (gpio >= GPIOMUX_NGPIOS)
+       if (!msm_gpiomux_recs)
+               return -EFAULT;
+
+       if (gpio >= msm_gpiomux_ngpio)
                return -EINVAL;
 
        spin_lock_irqsave(&gpiomux_lock, irq_flags);
@@ -50,10 +61,13 @@ EXPORT_SYMBOL(msm_gpiomux_write);
 
 int msm_gpiomux_get(unsigned gpio)
 {
-       struct msm_gpiomux_config *cfg = msm_gpiomux_configs + gpio;
+       struct msm_gpiomux_rec *cfg = msm_gpiomux_recs + gpio;
        unsigned long irq_flags;
 
-       if (gpio >= GPIOMUX_NGPIOS)
+       if (!msm_gpiomux_recs)
+               return -EFAULT;
+
+       if (gpio >= msm_gpiomux_ngpio)
                return -EINVAL;
 
        spin_lock_irqsave(&gpiomux_lock, irq_flags);
@@ -66,10 +80,13 @@ EXPORT_SYMBOL(msm_gpiomux_get);
 
 int msm_gpiomux_put(unsigned gpio)
 {
-       struct msm_gpiomux_config *cfg = msm_gpiomux_configs + gpio;
+       struct msm_gpiomux_rec *cfg = msm_gpiomux_recs + gpio;
        unsigned long irq_flags;
 
-       if (gpio >= GPIOMUX_NGPIOS)
+       if (!msm_gpiomux_recs)
+               return -EFAULT;
+
+       if (gpio >= msm_gpiomux_ngpio)
                return -EINVAL;
 
        spin_lock_irqsave(&gpiomux_lock, irq_flags);
@@ -81,16 +98,39 @@ int msm_gpiomux_put(unsigned gpio)
 }
 EXPORT_SYMBOL(msm_gpiomux_put);
 
-static int __init gpiomux_init(void)
+int msm_gpiomux_init(size_t ngpio)
+{
+       if (!ngpio)
+               return -EINVAL;
+
+       if (msm_gpiomux_recs)
+               return -EPERM;
+
+       msm_gpiomux_recs = kzalloc(sizeof(struct msm_gpiomux_rec) * ngpio,
+                                  GFP_KERNEL);
+       if (!msm_gpiomux_recs)
+               return -ENOMEM;
+
+       msm_gpiomux_ngpio = ngpio;
+
+       return 0;
+}
+EXPORT_SYMBOL(msm_gpiomux_init);
+
+void msm_gpiomux_install(struct msm_gpiomux_config *configs, unsigned nconfigs)
 {
        unsigned n;
+       int rc;
+
+       if (!msm_gpiomux_recs)
+               return;
 
-       for (n = 0; n < GPIOMUX_NGPIOS; ++n) {
-               msm_gpiomux_configs[n].ref = 0;
-               if (!(msm_gpiomux_configs[n].suspended & GPIOMUX_VALID))
-                       continue;
-               __msm_gpiomux_write(n, msm_gpiomux_configs[n].suspended);
+       for (n = 0; n < nconfigs; ++n) {
+               rc = msm_gpiomux_write(configs[n].gpio,
+                                      configs[n].active,
+                                      configs[n].suspended);
+               if (rc)
+                       pr_err("%s: write failure: %d\n", __func__, rc);
        }
-       return 0;
 }
-postcore_initcall(gpiomux_init);
+EXPORT_SYMBOL(msm_gpiomux_install);
diff --git a/arch/arm/mach-msm/gpiomux.h b/arch/arm/mach-msm/gpiomux.h
index b178d9c..38bf511 100644
--- a/arch/arm/mach-msm/gpiomux.h
+++ b/arch/arm/mach-msm/gpiomux.h
@@ -37,17 +37,16 @@
  * Available settings differ by target; see the gpiomux header
  * specific to your target arch for available configurations.
  *
+ * @gpio: The index number of the gpio being described.
  * @active: The configuration to be installed when the line is
  * active, or its reference count is > 0.
  * @suspended: The configuration to be installed when the line
  * is suspended, or its reference count is 0.
- * @ref: The reference count of the line.  For internal use of
- * the gpiomux framework only.
  */
 struct msm_gpiomux_config {
+       unsigned         gpio;
        gpiomux_config_t active;
        gpiomux_config_t suspended;
-       unsigned         ref;
 };
 
 /**
@@ -63,13 +62,16 @@ enum {
 
 #ifdef CONFIG_MSM_GPIOMUX
 
-/* Each architecture must provide its own instance of this table.
- * To avoid having gpiomux manage any given gpio, one or both of
- * the entries can avoid setting GPIOMUX_VALID - the absence
- * of that flag will prevent the configuration from being applied
- * during state transitions.
+/* Before using gpiomux, initialize the subsystem by telling it how many
+ * gpios are going to be managed.  Calling any other gpiomux functions before
+ * msm_gpiomux_init is unsupported.
  */
-extern struct msm_gpiomux_config msm_gpiomux_configs[GPIOMUX_NGPIOS];
+int msm_gpiomux_init(size_t ngpio);
+
+/* Install a block of gpiomux configurations in gpiomux.  This is functionally
+ * identical to calling msm_gpiomux_write many times.
+ */
+void msm_gpiomux_install(struct msm_gpiomux_config *configs, unsigned 
nconfigs);
 
 /* Increment a gpio's reference count, possibly activating the line. */
 int __must_check msm_gpiomux_get(unsigned gpio);
@@ -94,6 +96,14 @@ int msm_gpiomux_write(unsigned gpio,
  */
 void __msm_gpiomux_write(unsigned gpio, gpiomux_config_t val);
 #else
+static inline int msm_gpiomux_init(size_t ngpio)
+{
+       return -ENOSYS;
+}
+
+static inline void
+msm_gpiomux_install(struct msm_gpiomux_config *configs, unsigned nconfigs) {}
+
 static inline int __must_check msm_gpiomux_get(unsigned gpio)
 {
        return -ENOSYS;
-- 
Sent by an employee of the Qualcomm Innovation Center,Inc
The Qualcomm Innovation Center, Inc. is a member of the Code Aurora Forum.

--
To unsubscribe from this list: send the line "unsubscribe linux-arm-msm" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to