gpio_valid() implementation is different for different SoCs. Hence handle them in SoC specific gpio files.
Signed-off-by: Charulatha V <[email protected]> --- arch/arm/mach-omap1/gpio15xx.c | 26 ++++++++++++++++++++- arch/arm/mach-omap1/gpio16xx.c | 32 ++++++++++++++++++++++---- arch/arm/mach-omap1/gpio7xx.c | 38 ++++++++++++++++++++++++++------ arch/arm/mach-omap2/gpio.c | 14 +++++++++++- arch/arm/plat-omap/gpio.c | 27 +--------------------- arch/arm/plat-omap/include/plat/gpio.h | 1 + 6 files changed, 98 insertions(+), 40 deletions(-) diff --git a/arch/arm/mach-omap1/gpio15xx.c b/arch/arm/mach-omap1/gpio15xx.c index eb2727a..9d7a3fa 100644 --- a/arch/arm/mach-omap1/gpio15xx.c +++ b/arch/arm/mach-omap1/gpio15xx.c @@ -22,6 +22,10 @@ #define OMAP1510_GPIO_BASE 0xFFFCE000 #define OMAP1510_GPIO_INDEX_MASK 0x0f +#define OMAP1510_GPIO_WIDTH 16 +#define OMAP1510_GPIO_BANK_CNT 2 +#define OMAP1510_NON_MPUIO_GPIO_VALID ((OMAP1510_GPIO_BANK_CNT - 1) *\ + OMAP1510_GPIO_WIDTH) /* gpio1 */ static struct __initdata resource omap15xx_mpu_gpio_resources[] = { @@ -39,7 +43,7 @@ static struct __initdata resource omap15xx_mpu_gpio_resources[] = { static struct __initdata omap_gpio_platform_data omap15xx_mpu_gpio_config = { .virtual_irq_start = IH_MPUIO_BASE, .bank_type = METHOD_MPUIO, - .bank_width = 16, + .bank_width = OMAP1510_GPIO_WIDTH, .bank_stride = 1, }; @@ -69,7 +73,7 @@ static struct __initdata resource omap15xx_gpio_resources[] = { static struct __initdata omap_gpio_platform_data omap15xx_gpio_config = { .virtual_irq_start = IH_GPIO_BASE, .bank_type = METHOD_GPIO_1510, - .bank_width = 16, + .bank_width = OMAP1510_GPIO_WIDTH, }; static struct __initdata platform_device omap15xx_gpio = { @@ -87,8 +91,26 @@ static int get_gpio_index(int gpio) return gpio & OMAP1510_GPIO_INDEX_MASK; } +static int gpio_valid(int gpio) +{ + if (gpio < 0) + return -EINVAL; + + if (OMAP_GPIO_IS_MPUIO(gpio)) { + if (gpio >= OMAP_MAX_GPIO_LINES + OMAP1510_GPIO_WIDTH) + return -EINVAL; + return 0; + } + + if (gpio < OMAP1510_NON_MPUIO_GPIO_VALID) + return 0; + + return -EINVAL; +} + static struct omap_gpio_func gpio_fn = { .get_index = get_gpio_index, + .gpio_valid = gpio_valid, }; /* diff --git a/arch/arm/mach-omap1/gpio16xx.c b/arch/arm/mach-omap1/gpio16xx.c index 9d8aabc..e6bb080 100644 --- a/arch/arm/mach-omap1/gpio16xx.c +++ b/arch/arm/mach-omap1/gpio16xx.c @@ -25,6 +25,10 @@ #define OMAP1_MPUIO_VBASE OMAP1_MPUIO_BASE #define OMAP1610_GPIO_INDEX_MASK 0x0f +#define OMAP1610_GPIO_WIDTH 16 +#define OMAP1610_GPIO_BANK_CNT 5 +#define OMAP1610_NON_MPUIO_GPIO_VALID ((OMAP1610_GPIO_BANK_CNT - 1) *\ + OMAP1610_GPIO_WIDTH) /* mpu gpio */ static struct __initdata resource omap16xx_mpu_gpio_resources[] = { @@ -42,7 +46,7 @@ static struct __initdata resource omap16xx_mpu_gpio_resources[] = { static struct __initdata omap_gpio_platform_data omap16xx_mpu_gpio_config = { .virtual_irq_start = IH_MPUIO_BASE, .bank_type = METHOD_MPUIO, - .bank_width = 16, + .bank_width = OMAP1610_GPIO_WIDTH, .bank_stride = 1, }; @@ -72,7 +76,7 @@ static struct __initdata resource omap16xx_gpio1_resources[] = { static struct __initdata omap_gpio_platform_data omap16xx_gpio1_config = { .virtual_irq_start = IH_GPIO_BASE, .bank_type = METHOD_GPIO_1610, - .bank_width = 16, + .bank_width = OMAP1610_GPIO_WIDTH, }; static struct __initdata platform_device omap16xx_gpio1 = { @@ -101,7 +105,7 @@ static struct __initdata resource omap16xx_gpio2_resources[] = { static struct __initdata omap_gpio_platform_data omap16xx_gpio2_config = { .virtual_irq_start = IH_GPIO_BASE + 16, .bank_type = METHOD_GPIO_1610, - .bank_width = 16, + .bank_width = OMAP1610_GPIO_WIDTH, }; static struct __initdata platform_device omap16xx_gpio2 = { @@ -130,7 +134,7 @@ static struct __initdata resource omap16xx_gpio3_resources[] = { static struct __initdata omap_gpio_platform_data omap16xx_gpio3_config = { .virtual_irq_start = IH_GPIO_BASE + 32, .bank_type = METHOD_GPIO_1610, - .bank_width = 16, + .bank_width = OMAP1610_GPIO_WIDTH, }; static struct __initdata platform_device omap16xx_gpio3 = { @@ -159,7 +163,7 @@ static struct __initdata resource omap16xx_gpio4_resources[] = { static struct __initdata omap_gpio_platform_data omap16xx_gpio4_config = { .virtual_irq_start = IH_GPIO_BASE + 48, .bank_type = METHOD_GPIO_1610, - .bank_width = 16, + .bank_width = OMAP1610_GPIO_WIDTH, }; static struct __initdata platform_device omap16xx_gpio4 = { @@ -185,8 +189,26 @@ static int get_gpio_index(int gpio) return gpio & OMAP1610_GPIO_INDEX_MASK; } +static int gpio_valid(int gpio) +{ + if (gpio < 0) + return -EINVAL; + + if (OMAP_GPIO_IS_MPUIO(gpio)) { + if (gpio >= OMAP_MAX_GPIO_LINES + OMAP1610_GPIO_WIDTH) + return -EINVAL; + return 0; + } + + if (gpio < OMAP1610_NON_MPUIO_GPIO_VALID) + return 0; + + return -EINVAL; +} + static struct omap_gpio_func gpio_fn = { .get_index = get_gpio_index, + .gpio_valid = gpio_valid, }; /* diff --git a/arch/arm/mach-omap1/gpio7xx.c b/arch/arm/mach-omap1/gpio7xx.c index 74456a9..bd6fc8e 100644 --- a/arch/arm/mach-omap1/gpio7xx.c +++ b/arch/arm/mach-omap1/gpio7xx.c @@ -28,6 +28,12 @@ #define OMAP7XX_GPIO_INDEX_MASK 0x1f +#define OMAP7XX_GPIO_WIDTH 32 +#define OMAP7XX_MPUIO_GPIO_PIN_CNT 16 +#define OMAP7XX_GPIO_BANK_CNT 7 +#define OMAP7XX_NON_MPUIO_GPIO_VALID ((OMAP7XX_GPIO_BANK_CNT - 1) *\ + OMAP7XX_GPIO_WIDTH) + /* mpu gpio */ static struct __initdata resource omap7xx_mpu_gpio_resources[] = { { @@ -44,7 +50,7 @@ static struct __initdata resource omap7xx_mpu_gpio_resources[] = { static struct __initdata omap_gpio_platform_data omap7xx_mpu_gpio_config = { .virtual_irq_start = IH_MPUIO_BASE, .bank_type = METHOD_MPUIO, - .bank_width = 32, + .bank_width = OMAP7XX_GPIO_WIDTH, .bank_stride = 2, }; @@ -74,7 +80,7 @@ static struct __initdata resource omap7xx_gpio1_resources[] = { static struct __initdata omap_gpio_platform_data omap7xx_gpio1_config = { .virtual_irq_start = IH_GPIO_BASE, .bank_type = METHOD_GPIO_7XX, - .bank_width = 32, + .bank_width = OMAP7XX_GPIO_WIDTH, }; static struct __initdata platform_device omap7xx_gpio1 = { @@ -103,7 +109,7 @@ static struct __initdata resource omap7xx_gpio2_resources[] = { static struct __initdata omap_gpio_platform_data omap7xx_gpio2_config = { .virtual_irq_start = IH_GPIO_BASE + 32, .bank_type = METHOD_GPIO_7XX, - .bank_width = 32, + .bank_width = OMAP7XX_GPIO_WIDTH, }; static struct __initdata platform_device omap7xx_gpio2 = { @@ -132,7 +138,7 @@ static struct __initdata resource omap7xx_gpio3_resources[] = { static struct __initdata omap_gpio_platform_data omap7xx_gpio3_config = { .virtual_irq_start = IH_GPIO_BASE + 64, .bank_type = METHOD_GPIO_7XX, - .bank_width = 32, + .bank_width = OMAP7XX_GPIO_WIDTH, }; static struct __initdata platform_device omap7xx_gpio3 = { @@ -161,7 +167,7 @@ static struct __initdata resource omap7xx_gpio4_resources[] = { static struct __initdata omap_gpio_platform_data omap7xx_gpio4_config = { .virtual_irq_start = IH_GPIO_BASE + 96, .bank_type = METHOD_GPIO_7XX, - .bank_width = 32, + .bank_width = OMAP7XX_GPIO_WIDTH, }; static struct __initdata platform_device omap7xx_gpio4 = { @@ -190,7 +196,7 @@ static struct __initdata resource omap7xx_gpio5_resources[] = { static struct __initdata omap_gpio_platform_data omap7xx_gpio5_config = { .virtual_irq_start = IH_GPIO_BASE + 128, .bank_type = METHOD_GPIO_7XX, - .bank_width = 32, + .bank_width = OMAP7XX_GPIO_WIDTH, }; static struct __initdata platform_device omap7xx_gpio5 = { @@ -219,7 +225,7 @@ static struct __initdata resource omap7xx_gpio6_resources[] = { static struct __initdata omap_gpio_platform_data omap7xx_gpio6_config = { .virtual_irq_start = IH_GPIO_BASE + 160, .bank_type = METHOD_GPIO_7XX, - .bank_width = 32, + .bank_width = OMAP7XX_GPIO_WIDTH, }; static struct __initdata platform_device omap7xx_gpio6 = { @@ -247,8 +253,26 @@ static int get_gpio_index(int gpio) return gpio & OMAP7XX_GPIO_INDEX_MASK; } +static int gpio_valid(int gpio) +{ + if (gpio < 0) + return -EINVAL; + + if (OMAP_GPIO_IS_MPUIO(gpio)) { + if (gpio >= OMAP_MAX_GPIO_LINES + OMAP7XX_MPUIO_GPIO_PIN_CNT) + return -EINVAL; + return 0; + } + + if (gpio < OMAP7XX_NON_MPUIO_GPIO_VALID) + return 0; + + return -EINVAL; +} + static struct omap_gpio_func gpio_fn = { .get_index = get_gpio_index, + .gpio_valid = gpio_valid, }; /* diff --git a/arch/arm/mach-omap2/gpio.c b/arch/arm/mach-omap2/gpio.c index 498ab92..08ee5f1 100644 --- a/arch/arm/mach-omap2/gpio.c +++ b/arch/arm/mach-omap2/gpio.c @@ -26,6 +26,8 @@ #define OMAP2_GPIO_INDEX_MASK 0x1f +int bank_width; + static struct omap_device_pm_latency omap_gpio_latency[] = { [0] = { .deactivate_func = omap_device_idle_hwmods, @@ -39,8 +41,17 @@ static int get_gpio_index(int gpio) return gpio & OMAP2_GPIO_INDEX_MASK; } +static int gpio_valid(int gpio) +{ + if ((gpio >= 0) && (gpio < (gpio_bank_count * bank_width))) + return 0; + + return -EINVAL; +} + static struct omap_gpio_func gpio_fn = { .get_index = get_gpio_index, + .gpio_valid = gpio_valid, }; static int omap2_gpio_dev_init(struct omap_hwmod *oh, void *unused) @@ -68,7 +79,8 @@ static int omap2_gpio_dev_init(struct omap_hwmod *oh, void *unused) } dev_attr = (struct omap_gpio_dev_attr *)oh->dev_attr; - pdata->bank_width = dev_attr->bank_width; + bank_width = dev_attr->bank_width; + pdata->bank_width = bank_width; pdata->dbck_flag = dev_attr->dbck_flag; pdata->virtual_irq_start = IH_GPIO_BASE + 32 * (id - 1); pdata->gpio_fn = &gpio_fn; diff --git a/arch/arm/plat-omap/gpio.c b/arch/arm/plat-omap/gpio.c index e70bb6e..0f1dbbf 100644 --- a/arch/arm/plat-omap/gpio.c +++ b/arch/arm/plat-omap/gpio.c @@ -190,33 +190,9 @@ static int bank_width; /* TODO: Analyze removing gpio_bank_count usage from driver code */ int gpio_bank_count; -static inline int gpio_valid(int gpio) -{ - if (gpio < 0) - return -1; - if (cpu_class_is_omap1() && OMAP_GPIO_IS_MPUIO(gpio)) { - if (gpio >= OMAP_MAX_GPIO_LINES + 16) - return -1; - return 0; - } - if (cpu_is_omap15xx() && gpio < 16) - return 0; - if ((cpu_is_omap16xx()) && gpio < 64) - return 0; - if (cpu_is_omap7xx() && gpio < 192) - return 0; - if (cpu_is_omap2420() && gpio < 128) - return 0; - if (cpu_is_omap2430() && gpio < 160) - return 0; - if ((cpu_is_omap34xx() || cpu_is_omap44xx()) && gpio < 192) - return 0; - return -1; -} - static int check_gpio(int gpio) { - if (unlikely(gpio_valid(gpio) < 0)) { + if (unlikely(gpio_fn.gpio_valid(gpio) < 0)) { printk(KERN_ERR "omap-gpio: invalid GPIO %d\n", gpio); dump_stack(); return -1; @@ -1666,6 +1642,7 @@ static int __devinit omap_gpio_probe(struct platform_device *pdev) mpuio_init(); gpio_fn.get_index = pdata->gpio_fn->get_index; + gpio_fn.gpio_valid = pdata->gpio_fn->gpio_valid; } id = pdev->id; diff --git a/arch/arm/plat-omap/include/plat/gpio.h b/arch/arm/plat-omap/include/plat/gpio.h index 1cfb01b..00586ad 100644 --- a/arch/arm/plat-omap/include/plat/gpio.h +++ b/arch/arm/plat-omap/include/plat/gpio.h @@ -73,6 +73,7 @@ struct omap_gpio_dev_attr { struct omap_gpio_func { int (*get_index)(int gpio); + int (*gpio_valid)(int gpio); }; struct omap_gpio_platform_data { -- 1.7.1 -- To unsubscribe from this list: send the line "unsubscribe linux-omap" in the body of a message to [email protected] More majordomo info at http://vger.kernel.org/majordomo-info.html
