| 1 | From 6b5e2ee7c8f9722d59213f17d423b3f90d80f822 Mon Sep 17 00:00:00 2001 |
| 2 | From: John Crispin <blogic@openwrt.org> |
| 3 | Date: Sat, 13 Aug 2011 13:59:50 +0200 |
| 4 | Subject: [PATCH 12/24] MIPS: lantiq: adds GPIO3 support on AR9 |
| 5 | |
| 6 | There are 3 16bit and 1 8bit gpio ports on AR9. The gpio driver needs a hack |
| 7 | at 2 places to make the different register layout of the GPIO3 work properly |
| 8 | with the driver. Before only GPIO0-2 were supported. As the GPIO number scheme |
| 9 | clashes with the new size, we also move the other gpio chips to new offsets. |
| 10 | |
| 11 | Signed-off-by: John Crispin <blogic@openwrt.org> |
| 12 | Signed-off-by: Thomas Langer <thomas.langer@lantiq.com> |
| 13 | --- |
| 14 | .../mips/include/asm/mach-lantiq/xway/lantiq_soc.h | 2 + |
| 15 | arch/mips/lantiq/xway/devices.c | 3 + |
| 16 | arch/mips/lantiq/xway/gpio.c | 62 ++++++++++++++++---- |
| 17 | arch/mips/lantiq/xway/gpio_ebu.c | 3 +- |
| 18 | arch/mips/lantiq/xway/gpio_stp.c | 3 +- |
| 19 | 5 files changed, 57 insertions(+), 16 deletions(-) |
| 20 | |
| 21 | diff --git a/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h b/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h |
| 22 | index da8ff95..421768e 100644 |
| 23 | --- a/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h |
| 24 | +++ b/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h |
| 25 | @@ -113,7 +113,9 @@ |
| 26 | #define LTQ_GPIO0_BASE_ADDR 0x1E100B10 |
| 27 | #define LTQ_GPIO1_BASE_ADDR 0x1E100B40 |
| 28 | #define LTQ_GPIO2_BASE_ADDR 0x1E100B70 |
| 29 | +#define LTQ_GPIO3_BASE_ADDR 0x1E100BA0 |
| 30 | #define LTQ_GPIO_SIZE 0x30 |
| 31 | +#define LTQ_GPIO3_SIZE 0x10 |
| 32 | |
| 33 | /* SSC */ |
| 34 | #define LTQ_SSC_BASE_ADDR 0x1e100800 |
| 35 | diff --git a/arch/mips/lantiq/xway/devices.c b/arch/mips/lantiq/xway/devices.c |
| 36 | index 9bacaa8..b7efac5 100644 |
| 37 | --- a/arch/mips/lantiq/xway/devices.c |
| 38 | +++ b/arch/mips/lantiq/xway/devices.c |
| 39 | @@ -34,6 +34,7 @@ static struct resource ltq_gpio_resource[] = { |
| 40 | MEM_RES("gpio0", LTQ_GPIO0_BASE_ADDR, LTQ_GPIO_SIZE), |
| 41 | MEM_RES("gpio1", LTQ_GPIO1_BASE_ADDR, LTQ_GPIO_SIZE), |
| 42 | MEM_RES("gpio2", LTQ_GPIO2_BASE_ADDR, LTQ_GPIO_SIZE), |
| 43 | + MEM_RES("gpio3", LTQ_GPIO3_BASE_ADDR, LTQ_GPIO3_SIZE), |
| 44 | }; |
| 45 | |
| 46 | void __init ltq_register_gpio(void) |
| 47 | @@ -47,6 +48,8 @@ void __init ltq_register_gpio(void) |
| 48 | if (ltq_is_ar9() || ltq_is_vr9()) { |
| 49 | platform_device_register_simple("ltq_gpio", 2, |
| 50 | <q_gpio_resource[2], 1); |
| 51 | + platform_device_register_simple("ltq_gpio", 3, |
| 52 | + <q_gpio_resource[3], 1); |
| 53 | } |
| 54 | } |
| 55 | |
| 56 | diff --git a/arch/mips/lantiq/xway/gpio.c b/arch/mips/lantiq/xway/gpio.c |
| 57 | index a321451..2c48c17 100644 |
| 58 | --- a/arch/mips/lantiq/xway/gpio.c |
| 59 | +++ b/arch/mips/lantiq/xway/gpio.c |
| 60 | @@ -21,9 +21,15 @@ |
| 61 | #define LTQ_GPIO_ALTSEL0 0x0C |
| 62 | #define LTQ_GPIO_ALTSEL1 0x10 |
| 63 | #define LTQ_GPIO_OD 0x14 |
| 64 | +#define LTQ_GPIO3_OD 0x24 |
| 65 | +#define LTQ_GPIO3_ALTSEL1 0x24 |
| 66 | |
| 67 | +/* PORT3 only has 8 pins and its register layout |
| 68 | + is slightly different */ |
| 69 | #define PINS_PER_PORT 16 |
| 70 | -#define MAX_PORTS 3 |
| 71 | +#define PINS_PORT3 8 |
| 72 | +#define MAX_PORTS 4 |
| 73 | +#define MAX_PIN 56 |
| 74 | |
| 75 | #define ltq_gpio_getbit(m, r, p) (!!(ltq_r32(m + r) & (1 << p))) |
| 76 | #define ltq_gpio_setbit(m, r, p) ltq_w32_mask(0, (1 << p), m + r) |
| 77 | @@ -53,7 +59,7 @@ int ltq_gpio_request(unsigned int pin, unsigned int alt0, |
| 78 | { |
| 79 | int id = 0; |
| 80 | |
| 81 | - if (pin >= (MAX_PORTS * PINS_PER_PORT)) |
| 82 | + if (pin >= MAX_PIN) |
| 83 | return -EINVAL; |
| 84 | if (gpio_request(pin, name)) { |
| 85 | pr_err("failed to setup lantiq gpio: %s\n", name); |
| 86 | @@ -73,12 +79,21 @@ int ltq_gpio_request(unsigned int pin, unsigned int alt0, |
| 87 | else |
| 88 | ltq_gpio_clearbit(ltq_gpio_port[id].membase, |
| 89 | LTQ_GPIO_ALTSEL0, pin); |
| 90 | - if (alt1) |
| 91 | - ltq_gpio_setbit(ltq_gpio_port[id].membase, |
| 92 | - LTQ_GPIO_ALTSEL1, pin); |
| 93 | - else |
| 94 | - ltq_gpio_clearbit(ltq_gpio_port[id].membase, |
| 95 | - LTQ_GPIO_ALTSEL1, pin); |
| 96 | + if (id == 3) { |
| 97 | + if (alt1) |
| 98 | + ltq_gpio_setbit(ltq_gpio_port[1].membase, |
| 99 | + LTQ_GPIO3_ALTSEL1, pin); |
| 100 | + else |
| 101 | + ltq_gpio_clearbit(ltq_gpio_port[1].membase, |
| 102 | + LTQ_GPIO3_ALTSEL1, pin); |
| 103 | + } else { |
| 104 | + if (alt1) |
| 105 | + ltq_gpio_setbit(ltq_gpio_port[id].membase, |
| 106 | + LTQ_GPIO_ALTSEL1, pin); |
| 107 | + else |
| 108 | + ltq_gpio_clearbit(ltq_gpio_port[id].membase, |
| 109 | + LTQ_GPIO_ALTSEL1, pin); |
| 110 | + } |
| 111 | return 0; |
| 112 | } |
| 113 | EXPORT_SYMBOL(ltq_gpio_request); |
| 114 | @@ -104,7 +119,11 @@ static int ltq_gpio_direction_input(struct gpio_chip *chip, unsigned int offset) |
| 115 | { |
| 116 | struct ltq_gpio *ltq_gpio = container_of(chip, struct ltq_gpio, chip); |
| 117 | |
| 118 | - ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_OD, offset); |
| 119 | + if (chip->ngpio == PINS_PORT3) |
| 120 | + ltq_gpio_clearbit(ltq_gpio_port[0].membase, |
| 121 | + LTQ_GPIO3_OD, offset); |
| 122 | + else |
| 123 | + ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_OD, offset); |
| 124 | ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_DIR, offset); |
| 125 | |
| 126 | return 0; |
| 127 | @@ -115,7 +134,10 @@ static int ltq_gpio_direction_output(struct gpio_chip *chip, |
| 128 | { |
| 129 | struct ltq_gpio *ltq_gpio = container_of(chip, struct ltq_gpio, chip); |
| 130 | |
| 131 | - ltq_gpio_setbit(ltq_gpio->membase, LTQ_GPIO_OD, offset); |
| 132 | + if (chip->ngpio == PINS_PORT3) |
| 133 | + ltq_gpio_setbit(ltq_gpio_port[0].membase, LTQ_GPIO3_OD, offset); |
| 134 | + else |
| 135 | + ltq_gpio_setbit(ltq_gpio->membase, LTQ_GPIO_OD, offset); |
| 136 | ltq_gpio_setbit(ltq_gpio->membase, LTQ_GPIO_DIR, offset); |
| 137 | ltq_gpio_set(chip, offset, value); |
| 138 | |
| 139 | @@ -127,7 +149,11 @@ static int ltq_gpio_req(struct gpio_chip *chip, unsigned offset) |
| 140 | struct ltq_gpio *ltq_gpio = container_of(chip, struct ltq_gpio, chip); |
| 141 | |
| 142 | ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_ALTSEL0, offset); |
| 143 | - ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_ALTSEL1, offset); |
| 144 | + if (chip->ngpio == PINS_PORT3) |
| 145 | + ltq_gpio_clearbit(ltq_gpio_port[1].membase, |
| 146 | + LTQ_GPIO3_ALTSEL1, offset); |
| 147 | + else |
| 148 | + ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_ALTSEL1, offset); |
| 149 | return 0; |
| 150 | } |
| 151 | |
| 152 | @@ -140,6 +166,15 @@ static int ltq_gpio_probe(struct platform_device *pdev) |
| 153 | pdev->id); |
| 154 | return -EINVAL; |
| 155 | } |
| 156 | + |
| 157 | + /* dirty hack - The registers of port3 are not mapped linearly. |
| 158 | + Port 3 may only load if Port 1/2 are mapped */ |
| 159 | + if ((pdev->id == 3) && (!ltq_gpio_port[1].membase || !ltq_gpio_port[2].membase)) { |
| 160 | + dev_err(&pdev->dev, |
| 161 | + "ports 1/2 need to be loaded before port 3 works\n"); |
| 162 | + return -ENOMEM; |
| 163 | + } |
| 164 | + |
| 165 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 166 | if (!res) { |
| 167 | dev_err(&pdev->dev, "failed to get memory for gpio port %d\n", |
| 168 | @@ -169,7 +204,10 @@ static int ltq_gpio_probe(struct platform_device *pdev) |
| 169 | ltq_gpio_port[pdev->id].chip.set = ltq_gpio_set; |
| 170 | ltq_gpio_port[pdev->id].chip.request = ltq_gpio_req; |
| 171 | ltq_gpio_port[pdev->id].chip.base = PINS_PER_PORT * pdev->id; |
| 172 | - ltq_gpio_port[pdev->id].chip.ngpio = PINS_PER_PORT; |
| 173 | + if (pdev->id == 3) |
| 174 | + ltq_gpio_port[pdev->id].chip.ngpio = PINS_PORT3; |
| 175 | + else |
| 176 | + ltq_gpio_port[pdev->id].chip.ngpio = PINS_PER_PORT; |
| 177 | platform_set_drvdata(pdev, <q_gpio_port[pdev->id]); |
| 178 | return gpiochip_add(<q_gpio_port[pdev->id].chip); |
| 179 | } |
| 180 | diff --git a/arch/mips/lantiq/xway/gpio_ebu.c b/arch/mips/lantiq/xway/gpio_ebu.c |
| 181 | index a479355..729f8e3 100644 |
| 182 | --- a/arch/mips/lantiq/xway/gpio_ebu.c |
| 183 | +++ b/arch/mips/lantiq/xway/gpio_ebu.c |
| 184 | @@ -61,9 +61,8 @@ static struct gpio_chip ltq_ebu_chip = { |
| 185 | .label = "ltq_ebu", |
| 186 | .direction_output = ltq_ebu_direction_output, |
| 187 | .set = ltq_ebu_set, |
| 188 | - .base = 72, |
| 189 | + .base = 100, |
| 190 | .ngpio = 16, |
| 191 | - .can_sleep = 1, |
| 192 | .owner = THIS_MODULE, |
| 193 | }; |
| 194 | |
| 195 | diff --git a/arch/mips/lantiq/xway/gpio_stp.c b/arch/mips/lantiq/xway/gpio_stp.c |
| 196 | index 67d59d6..c01294e 100644 |
| 197 | --- a/arch/mips/lantiq/xway/gpio_stp.c |
| 198 | +++ b/arch/mips/lantiq/xway/gpio_stp.c |
| 199 | @@ -70,9 +70,8 @@ static struct gpio_chip ltq_stp_chip = { |
| 200 | .label = "ltq_stp", |
| 201 | .direction_output = ltq_stp_direction_output, |
| 202 | .set = ltq_stp_set, |
| 203 | - .base = 48, |
| 204 | + .base = 200, |
| 205 | .ngpio = 24, |
| 206 | - .can_sleep = 1, |
| 207 | .owner = THIS_MODULE, |
| 208 | }; |
| 209 | |
| 210 | -- |
| 211 | 1.7.5.4 |
| 212 | |
| 213 | |