| /* arch/arm/plat-s3c64xx/gpiolib.c |
| * |
| * Copyright 2008 Openmoko, Inc. |
| * Copyright 2008 Simtec Electronics |
| * Ben Dooks <ben@simtec.co.uk> |
| * http://armlinux.simtec.co.uk/ |
| * |
| * S3C64XX - GPIOlib support |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/irq.h> |
| #include <linux/io.h> |
| |
| #include <mach/map.h> |
| #include <mach/gpio.h> |
| #include <mach/gpio-core.h> |
| |
| #include <plat/gpio-cfg.h> |
| #include <plat/gpio-cfg-helpers.h> |
| #include <plat/regs-gpio.h> |
| |
| /* GPIO bank summary: |
| * |
| * Bank GPIOs Style SlpCon ExtInt Group |
| * A 8 4Bit Yes 1 |
| * B 7 4Bit Yes 1 |
| * C 8 4Bit Yes 2 |
| * D 5 4Bit Yes 3 |
| * E 5 4Bit Yes None |
| * F 16 2Bit Yes 4 [1] |
| * G 7 4Bit Yes 5 |
| * H 10 4Bit[2] Yes 6 |
| * I 16 2Bit Yes None |
| * J 12 2Bit Yes None |
| * K 16 4Bit[2] No None |
| * L 15 4Bit[2] No None |
| * M 6 4Bit No IRQ_EINT |
| * N 16 2Bit No IRQ_EINT |
| * O 16 2Bit Yes 7 |
| * P 15 2Bit Yes 8 |
| * Q 9 2Bit Yes 9 |
| * |
| * [1] BANKF pins 14,15 do not form part of the external interrupt sources |
| * [2] BANK has two control registers, GPxCON0 and GPxCON1 |
| */ |
| |
| #define OFF_GPCON (0x00) |
| #define OFF_GPDAT (0x04) |
| |
| #define con_4bit_shift(__off) ((__off) * 4) |
| |
| #if 1 |
| #define gpio_dbg(x...) do { } while(0) |
| #else |
| #define gpio_dbg(x...) printk(KERN_DEBUG x) |
| #endif |
| |
| /* The s3c64xx_gpiolib_4bit routines are to control the gpio banks where |
| * the gpio configuration register (GPxCON) has 4 bits per GPIO, as the |
| * following example: |
| * |
| * base + 0x00: Control register, 4 bits per gpio |
| * gpio n: 4 bits starting at (4*n) |
| * 0000 = input, 0001 = output, others mean special-function |
| * base + 0x04: Data register, 1 bit per gpio |
| * bit n: data bit n |
| * |
| * Note, since the data register is one bit per gpio and is at base + 0x4 |
| * we can use s3c_gpiolib_get and s3c_gpiolib_set to change the state of |
| * the output. |
| */ |
| |
| static int s3c64xx_gpiolib_4bit_input(struct gpio_chip *chip, unsigned offset) |
| { |
| struct s3c_gpio_chip *ourchip = to_s3c_gpio(chip); |
| void __iomem *base = ourchip->base; |
| unsigned long con; |
| |
| con = __raw_readl(base + OFF_GPCON); |
| con &= ~(0xf << con_4bit_shift(offset)); |
| __raw_writel(con, base + OFF_GPCON); |
| |
| gpio_dbg("%s: %p: CON now %08lx\n", __func__, base, con); |
| |
| return 0; |
| } |
| |
| static int s3c64xx_gpiolib_4bit_output(struct gpio_chip *chip, |
| unsigned offset, int value) |
| { |
| struct s3c_gpio_chip *ourchip = to_s3c_gpio(chip); |
| void __iomem *base = ourchip->base; |
| unsigned long con; |
| unsigned long dat; |
| |
| con = __raw_readl(base + OFF_GPCON); |
| con &= ~(0xf << con_4bit_shift(offset)); |
| con |= 0x1 << con_4bit_shift(offset); |
| |
| dat = __raw_readl(base + OFF_GPDAT); |
| if (value) |
| dat |= 1 << offset; |
| else |
| dat &= ~(1 << offset); |
| |
| __raw_writel(dat, base + OFF_GPDAT); |
| __raw_writel(con, base + OFF_GPCON); |
| __raw_writel(dat, base + OFF_GPDAT); |
| |
| gpio_dbg("%s: %p: CON %08lx, DAT %08lx\n", __func__, base, con, dat); |
| |
| return 0; |
| } |
| |
| /* The next set of routines are for the case where the GPIO configuration |
| * registers are 4 bits per GPIO but there is more than one register (the |
| * bank has more than 8 GPIOs. |
| * |
| * This case is the similar to the 4 bit case, but the registers are as |
| * follows: |
| * |
| * base + 0x00: Control register, 4 bits per gpio (lower 8 GPIOs) |
| * gpio n: 4 bits starting at (4*n) |
| * 0000 = input, 0001 = output, others mean special-function |
| * base + 0x04: Control register, 4 bits per gpio (up to 8 additions GPIOs) |
| * gpio n: 4 bits starting at (4*n) |
| * 0000 = input, 0001 = output, others mean special-function |
| * base + 0x08: Data register, 1 bit per gpio |
| * bit n: data bit n |
| * |
| * To allow us to use the s3c_gpiolib_get and s3c_gpiolib_set routines we |
| * store the 'base + 0x4' address so that these routines see the data |
| * register at ourchip->base + 0x04. |
| */ |
| |
| static int s3c64xx_gpiolib_4bit2_input(struct gpio_chip *chip, unsigned offset) |
| { |
| struct s3c_gpio_chip *ourchip = to_s3c_gpio(chip); |
| void __iomem *base = ourchip->base; |
| void __iomem *regcon = base; |
| unsigned long con; |
| |
| if (offset > 7) |
| offset -= 8; |
| else |
| regcon -= 4; |
| |
| con = __raw_readl(regcon); |
| con &= ~(0xf << con_4bit_shift(offset)); |
| __raw_writel(con, regcon); |
| |
| gpio_dbg("%s: %p: CON %08lx\n", __func__, base, con); |
| |
| return 0; |
| |
| } |
| |
| static int s3c64xx_gpiolib_4bit2_output(struct gpio_chip *chip, |
| unsigned offset, int value) |
| { |
| struct s3c_gpio_chip *ourchip = to_s3c_gpio(chip); |
| void __iomem *base = ourchip->base; |
| void __iomem *regcon = base; |
| unsigned long con; |
| unsigned long dat; |
| |
| if (offset > 7) |
| offset -= 8; |
| else |
| regcon -= 4; |
| |
| con = __raw_readl(regcon); |
| con &= ~(0xf << con_4bit_shift(offset)); |
| con |= 0x1 << con_4bit_shift(offset); |
| |
| dat = __raw_readl(base + OFF_GPDAT); |
| if (value) |
| dat |= 1 << offset; |
| else |
| dat &= ~(1 << offset); |
| |
| __raw_writel(dat, base + OFF_GPDAT); |
| __raw_writel(con, regcon); |
| __raw_writel(dat, base + OFF_GPDAT); |
| |
| gpio_dbg("%s: %p: CON %08lx, DAT %08lx\n", __func__, base, con, dat); |
| |
| return 0; |
| } |
| |
| static struct s3c_gpio_cfg gpio_4bit_cfg_noint = { |
| .set_config = s3c_gpio_setcfg_s3c64xx_4bit, |
| .set_pull = s3c_gpio_setpull_updown, |
| .get_pull = s3c_gpio_getpull_updown, |
| }; |
| |
| static struct s3c_gpio_cfg gpio_4bit_cfg_eint0111 = { |
| .cfg_eint = 7, |
| .set_config = s3c_gpio_setcfg_s3c64xx_4bit, |
| .set_pull = s3c_gpio_setpull_updown, |
| .get_pull = s3c_gpio_getpull_updown, |
| }; |
| |
| static struct s3c_gpio_cfg gpio_4bit_cfg_eint0011 = { |
| .cfg_eint = 3, |
| .set_config = s3c_gpio_setcfg_s3c64xx_4bit, |
| .set_pull = s3c_gpio_setpull_updown, |
| .get_pull = s3c_gpio_getpull_updown, |
| }; |
| |
| int s3c64xx_gpio2int_gpm(struct gpio_chip *chip, unsigned pin) |
| { |
| return pin < 5 ? IRQ_EINT(23) + pin : -ENXIO; |
| } |
| |
| static struct s3c_gpio_chip gpio_4bit[] = { |
| { |
| .base = S3C64XX_GPA_BASE, |
| .config = &gpio_4bit_cfg_eint0111, |
| .chip = { |
| .base = S3C64XX_GPA(0), |
| .ngpio = S3C64XX_GPIO_A_NR, |
| .label = "GPA", |
| }, |
| }, { |
| .base = S3C64XX_GPB_BASE, |
| .config = &gpio_4bit_cfg_eint0111, |
| .chip = { |
| .base = S3C64XX_GPB(0), |
| .ngpio = S3C64XX_GPIO_B_NR, |
| .label = "GPB", |
| }, |
| }, { |
| .base = S3C64XX_GPC_BASE, |
| .config = &gpio_4bit_cfg_eint0111, |
| .chip = { |
| .base = S3C64XX_GPC(0), |
| .ngpio = S3C64XX_GPIO_C_NR, |
| .label = "GPC", |
| }, |
| }, { |
| .base = S3C64XX_GPD_BASE, |
| .config = &gpio_4bit_cfg_eint0111, |
| .chip = { |
| .base = S3C64XX_GPD(0), |
| .ngpio = S3C64XX_GPIO_D_NR, |
| .label = "GPD", |
| }, |
| }, { |
| .base = S3C64XX_GPE_BASE, |
| .config = &gpio_4bit_cfg_noint, |
| .chip = { |
| .base = S3C64XX_GPE(0), |
| .ngpio = S3C64XX_GPIO_E_NR, |
| .label = "GPE", |
| }, |
| }, { |
| .base = S3C64XX_GPG_BASE, |
| .config = &gpio_4bit_cfg_eint0111, |
| .chip = { |
| .base = S3C64XX_GPG(0), |
| .ngpio = S3C64XX_GPIO_G_NR, |
| .label = "GPG", |
| }, |
| }, { |
| .base = S3C64XX_GPM_BASE, |
| .config = &gpio_4bit_cfg_eint0011, |
| .chip = { |
| .base = S3C64XX_GPM(0), |
| .ngpio = S3C64XX_GPIO_M_NR, |
| .label = "GPM", |
| .to_irq = s3c64xx_gpio2int_gpm, |
| }, |
| }, |
| }; |
| |
| int s3c64xx_gpio2int_gpl(struct gpio_chip *chip, unsigned pin) |
| { |
| return pin >= 8 ? IRQ_EINT(16) + pin - 8 : -ENXIO; |
| } |
| |
| static struct s3c_gpio_chip gpio_4bit2[] = { |
| { |
| .base = S3C64XX_GPH_BASE + 0x4, |
| .config = &gpio_4bit_cfg_eint0111, |
| .chip = { |
| .base = S3C64XX_GPH(0), |
| .ngpio = S3C64XX_GPIO_H_NR, |
| .label = "GPH", |
| }, |
| }, { |
| .base = S3C64XX_GPK_BASE + 0x4, |
| .config = &gpio_4bit_cfg_noint, |
| .chip = { |
| .base = S3C64XX_GPK(0), |
| .ngpio = S3C64XX_GPIO_K_NR, |
| .label = "GPK", |
| }, |
| }, { |
| .base = S3C64XX_GPL_BASE + 0x4, |
| .config = &gpio_4bit_cfg_eint0011, |
| .chip = { |
| .base = S3C64XX_GPL(0), |
| .ngpio = S3C64XX_GPIO_L_NR, |
| .label = "GPL", |
| .to_irq = s3c64xx_gpio2int_gpl, |
| }, |
| }, |
| }; |
| |
| static struct s3c_gpio_cfg gpio_2bit_cfg_noint = { |
| .set_config = s3c_gpio_setcfg_s3c24xx, |
| .set_pull = s3c_gpio_setpull_updown, |
| .get_pull = s3c_gpio_getpull_updown, |
| }; |
| |
| static struct s3c_gpio_cfg gpio_2bit_cfg_eint10 = { |
| .cfg_eint = 2, |
| .set_config = s3c_gpio_setcfg_s3c24xx, |
| .set_pull = s3c_gpio_setpull_updown, |
| .get_pull = s3c_gpio_getpull_updown, |
| }; |
| |
| static struct s3c_gpio_cfg gpio_2bit_cfg_eint11 = { |
| .cfg_eint = 3, |
| .set_config = s3c_gpio_setcfg_s3c24xx, |
| .set_pull = s3c_gpio_setpull_updown, |
| .get_pull = s3c_gpio_getpull_updown, |
| }; |
| |
| int s3c64xx_gpio2int_gpn(struct gpio_chip *chip, unsigned pin) |
| { |
| return IRQ_EINT(0) + pin; |
| } |
| |
| static struct s3c_gpio_chip gpio_2bit[] = { |
| { |
| .base = S3C64XX_GPF_BASE, |
| .config = &gpio_2bit_cfg_eint11, |
| .chip = { |
| .base = S3C64XX_GPF(0), |
| .ngpio = S3C64XX_GPIO_F_NR, |
| .label = "GPF", |
| }, |
| }, { |
| .base = S3C64XX_GPI_BASE, |
| .config = &gpio_2bit_cfg_noint, |
| .chip = { |
| .base = S3C64XX_GPI(0), |
| .ngpio = S3C64XX_GPIO_I_NR, |
| .label = "GPI", |
| }, |
| }, { |
| .base = S3C64XX_GPJ_BASE, |
| .config = &gpio_2bit_cfg_noint, |
| .chip = { |
| .base = S3C64XX_GPJ(0), |
| .ngpio = S3C64XX_GPIO_J_NR, |
| .label = "GPJ", |
| }, |
| }, { |
| .base = S3C64XX_GPN_BASE, |
| .config = &gpio_2bit_cfg_eint10, |
| .chip = { |
| .base = S3C64XX_GPN(0), |
| .ngpio = S3C64XX_GPIO_N_NR, |
| .label = "GPN", |
| .to_irq = s3c64xx_gpio2int_gpn, |
| }, |
| }, { |
| .base = S3C64XX_GPO_BASE, |
| .config = &gpio_2bit_cfg_eint11, |
| .chip = { |
| .base = S3C64XX_GPO(0), |
| .ngpio = S3C64XX_GPIO_O_NR, |
| .label = "GPO", |
| }, |
| }, { |
| .base = S3C64XX_GPP_BASE, |
| .config = &gpio_2bit_cfg_eint11, |
| .chip = { |
| .base = S3C64XX_GPP(0), |
| .ngpio = S3C64XX_GPIO_P_NR, |
| .label = "GPP", |
| }, |
| }, { |
| .base = S3C64XX_GPQ_BASE, |
| .config = &gpio_2bit_cfg_eint11, |
| .chip = { |
| .base = S3C64XX_GPQ(0), |
| .ngpio = S3C64XX_GPIO_Q_NR, |
| .label = "GPQ", |
| }, |
| }, |
| }; |
| |
| static __init void s3c64xx_gpiolib_add_4bit(struct s3c_gpio_chip *chip) |
| { |
| chip->chip.direction_input = s3c64xx_gpiolib_4bit_input; |
| chip->chip.direction_output = s3c64xx_gpiolib_4bit_output; |
| chip->pm = __gpio_pm(&s3c_gpio_pm_4bit); |
| } |
| |
| static __init void s3c64xx_gpiolib_add_4bit2(struct s3c_gpio_chip *chip) |
| { |
| chip->chip.direction_input = s3c64xx_gpiolib_4bit2_input; |
| chip->chip.direction_output = s3c64xx_gpiolib_4bit2_output; |
| chip->pm = __gpio_pm(&s3c_gpio_pm_4bit); |
| } |
| |
| static __init void s3c64xx_gpiolib_add_2bit(struct s3c_gpio_chip *chip) |
| { |
| chip->pm = __gpio_pm(&s3c_gpio_pm_2bit); |
| } |
| |
| static __init void s3c64xx_gpiolib_add(struct s3c_gpio_chip *chips, |
| int nr_chips, |
| void (*fn)(struct s3c_gpio_chip *)) |
| { |
| for (; nr_chips > 0; nr_chips--, chips++) { |
| if (fn) |
| (fn)(chips); |
| s3c_gpiolib_add(chips); |
| } |
| } |
| |
| static __init int s3c64xx_gpiolib_init(void) |
| { |
| s3c64xx_gpiolib_add(gpio_4bit, ARRAY_SIZE(gpio_4bit), |
| s3c64xx_gpiolib_add_4bit); |
| |
| s3c64xx_gpiolib_add(gpio_4bit2, ARRAY_SIZE(gpio_4bit2), |
| s3c64xx_gpiolib_add_4bit2); |
| |
| s3c64xx_gpiolib_add(gpio_2bit, ARRAY_SIZE(gpio_2bit), |
| s3c64xx_gpiolib_add_2bit); |
| |
| return 0; |
| } |
| |
| core_initcall(s3c64xx_gpiolib_init); |