Loading...
1/*
2 * Broadcom specific AMBA
3 * GPIO driver
4 *
5 * Copyright 2011, Broadcom Corporation
6 * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
7 *
8 * Licensed under the GNU/GPL. See COPYING for details.
9 */
10
11#include <linux/gpio/driver.h>
12#include <linux/interrupt.h>
13#include <linux/export.h>
14#include <linux/property.h>
15
16#include <linux/bcma/bcma.h>
17
18#include "bcma_private.h"
19
20#define BCMA_GPIO_MAX_PINS 32
21
22static int bcma_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
23{
24 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
25
26 return !!bcma_chipco_gpio_in(cc, 1 << gpio);
27}
28
29static void bcma_gpio_set_value(struct gpio_chip *chip, unsigned gpio,
30 int value)
31{
32 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
33
34 bcma_chipco_gpio_out(cc, 1 << gpio, value ? 1 << gpio : 0);
35}
36
37static int bcma_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
38{
39 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
40
41 bcma_chipco_gpio_outen(cc, 1 << gpio, 0);
42 return 0;
43}
44
45static int bcma_gpio_direction_output(struct gpio_chip *chip, unsigned gpio,
46 int value)
47{
48 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
49
50 bcma_chipco_gpio_outen(cc, 1 << gpio, 1 << gpio);
51 bcma_chipco_gpio_out(cc, 1 << gpio, value ? 1 << gpio : 0);
52 return 0;
53}
54
55static int bcma_gpio_request(struct gpio_chip *chip, unsigned gpio)
56{
57 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
58
59 bcma_chipco_gpio_control(cc, 1 << gpio, 0);
60 /* clear pulldown */
61 bcma_chipco_gpio_pulldown(cc, 1 << gpio, 0);
62 /* Set pullup */
63 bcma_chipco_gpio_pullup(cc, 1 << gpio, 1 << gpio);
64
65 return 0;
66}
67
68static void bcma_gpio_free(struct gpio_chip *chip, unsigned gpio)
69{
70 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
71
72 /* clear pullup */
73 bcma_chipco_gpio_pullup(cc, 1 << gpio, 0);
74}
75
76#if IS_BUILTIN(CONFIG_BCM47XX) || IS_BUILTIN(CONFIG_ARCH_BCM_5301X)
77
78static void bcma_gpio_irq_unmask(struct irq_data *d)
79{
80 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
81 struct bcma_drv_cc *cc = gpiochip_get_data(gc);
82 int gpio = irqd_to_hwirq(d);
83 u32 val = bcma_chipco_gpio_in(cc, BIT(gpio));
84
85 gpiochip_enable_irq(gc, gpio);
86 bcma_chipco_gpio_polarity(cc, BIT(gpio), val);
87 bcma_chipco_gpio_intmask(cc, BIT(gpio), BIT(gpio));
88}
89
90static void bcma_gpio_irq_mask(struct irq_data *d)
91{
92 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
93 struct bcma_drv_cc *cc = gpiochip_get_data(gc);
94 int gpio = irqd_to_hwirq(d);
95
96 bcma_chipco_gpio_intmask(cc, BIT(gpio), 0);
97 gpiochip_disable_irq(gc, gpio);
98}
99
100static const struct irq_chip bcma_gpio_irq_chip = {
101 .name = "BCMA-GPIO",
102 .irq_mask = bcma_gpio_irq_mask,
103 .irq_unmask = bcma_gpio_irq_unmask,
104 .flags = IRQCHIP_IMMUTABLE,
105 GPIOCHIP_IRQ_RESOURCE_HELPERS,
106};
107
108static irqreturn_t bcma_gpio_irq_handler(int irq, void *dev_id)
109{
110 struct bcma_drv_cc *cc = dev_id;
111 struct gpio_chip *gc = &cc->gpio;
112 u32 val = bcma_cc_read32(cc, BCMA_CC_GPIOIN);
113 u32 mask = bcma_cc_read32(cc, BCMA_CC_GPIOIRQ);
114 u32 pol = bcma_cc_read32(cc, BCMA_CC_GPIOPOL);
115 unsigned long irqs = (val ^ pol) & mask;
116 int gpio;
117
118 if (!irqs)
119 return IRQ_NONE;
120
121 for_each_set_bit(gpio, &irqs, gc->ngpio)
122 generic_handle_domain_irq_safe(gc->irq.domain, gpio);
123 bcma_chipco_gpio_polarity(cc, irqs, val & irqs);
124
125 return IRQ_HANDLED;
126}
127
128static int bcma_gpio_irq_init(struct bcma_drv_cc *cc)
129{
130 struct gpio_chip *chip = &cc->gpio;
131 struct gpio_irq_chip *girq = &chip->irq;
132 int hwirq, err;
133
134 if (cc->core->bus->hosttype != BCMA_HOSTTYPE_SOC)
135 return 0;
136
137 hwirq = bcma_core_irq(cc->core, 0);
138 err = request_irq(hwirq, bcma_gpio_irq_handler, IRQF_SHARED, "gpio",
139 cc);
140 if (err)
141 return err;
142
143 bcma_chipco_gpio_intmask(cc, ~0, 0);
144 bcma_cc_set32(cc, BCMA_CC_IRQMASK, BCMA_CC_IRQ_GPIO);
145
146 gpio_irq_chip_set_chip(girq, &bcma_gpio_irq_chip);
147 /* This will let us handle the parent IRQ in the driver */
148 girq->parent_handler = NULL;
149 girq->num_parents = 0;
150 girq->parents = NULL;
151 girq->default_type = IRQ_TYPE_NONE;
152 girq->handler = handle_simple_irq;
153
154 return 0;
155}
156
157static void bcma_gpio_irq_exit(struct bcma_drv_cc *cc)
158{
159 if (cc->core->bus->hosttype != BCMA_HOSTTYPE_SOC)
160 return;
161
162 bcma_cc_mask32(cc, BCMA_CC_IRQMASK, ~BCMA_CC_IRQ_GPIO);
163 free_irq(bcma_core_irq(cc->core, 0), cc);
164}
165#else
166static int bcma_gpio_irq_init(struct bcma_drv_cc *cc)
167{
168 return 0;
169}
170
171static void bcma_gpio_irq_exit(struct bcma_drv_cc *cc)
172{
173}
174#endif
175
176int bcma_gpio_init(struct bcma_drv_cc *cc)
177{
178 struct bcma_bus *bus = cc->core->bus;
179 struct gpio_chip *chip = &cc->gpio;
180 int err;
181
182 chip->label = "bcma_gpio";
183 chip->owner = THIS_MODULE;
184 chip->request = bcma_gpio_request;
185 chip->free = bcma_gpio_free;
186 chip->get = bcma_gpio_get_value;
187 chip->set = bcma_gpio_set_value;
188 chip->direction_input = bcma_gpio_direction_input;
189 chip->direction_output = bcma_gpio_direction_output;
190 chip->parent = bus->dev;
191 chip->fwnode = dev_fwnode(&cc->core->dev);
192
193 switch (bus->chipinfo.id) {
194 case BCMA_CHIP_ID_BCM4707:
195 case BCMA_CHIP_ID_BCM5357:
196 case BCMA_CHIP_ID_BCM53572:
197 case BCMA_CHIP_ID_BCM53573:
198 case BCMA_CHIP_ID_BCM47094:
199 chip->ngpio = 32;
200 break;
201 default:
202 chip->ngpio = 16;
203 }
204
205 /*
206 * Register SoC GPIO devices with absolute GPIO pin base.
207 * On MIPS, we don't have Device Tree and we can't use relative (per chip)
208 * GPIO numbers.
209 * On some ARM devices, user space may want to access some system GPIO
210 * pins directly, which is easier to do with a predictable GPIO base.
211 */
212 if (IS_BUILTIN(CONFIG_BCM47XX) ||
213 cc->core->bus->hosttype == BCMA_HOSTTYPE_SOC)
214 chip->base = bus->num * BCMA_GPIO_MAX_PINS;
215 else
216 chip->base = -1;
217
218 err = bcma_gpio_irq_init(cc);
219 if (err)
220 return err;
221
222 err = gpiochip_add_data(chip, cc);
223 if (err) {
224 bcma_gpio_irq_exit(cc);
225 return err;
226 }
227
228 return 0;
229}
230
231int bcma_gpio_unregister(struct bcma_drv_cc *cc)
232{
233 bcma_gpio_irq_exit(cc);
234 gpiochip_remove(&cc->gpio);
235 return 0;
236}
1/*
2 * Broadcom specific AMBA
3 * GPIO driver
4 *
5 * Copyright 2011, Broadcom Corporation
6 * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
7 *
8 * Licensed under the GNU/GPL. See COPYING for details.
9 */
10
11#include <linux/gpio/driver.h>
12#include <linux/interrupt.h>
13#include <linux/export.h>
14#include <linux/bcma/bcma.h>
15
16#include "bcma_private.h"
17
18#define BCMA_GPIO_MAX_PINS 32
19
20static int bcma_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
21{
22 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
23
24 return !!bcma_chipco_gpio_in(cc, 1 << gpio);
25}
26
27static void bcma_gpio_set_value(struct gpio_chip *chip, unsigned gpio,
28 int value)
29{
30 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
31
32 bcma_chipco_gpio_out(cc, 1 << gpio, value ? 1 << gpio : 0);
33}
34
35static int bcma_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
36{
37 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
38
39 bcma_chipco_gpio_outen(cc, 1 << gpio, 0);
40 return 0;
41}
42
43static int bcma_gpio_direction_output(struct gpio_chip *chip, unsigned gpio,
44 int value)
45{
46 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
47
48 bcma_chipco_gpio_outen(cc, 1 << gpio, 1 << gpio);
49 bcma_chipco_gpio_out(cc, 1 << gpio, value ? 1 << gpio : 0);
50 return 0;
51}
52
53static int bcma_gpio_request(struct gpio_chip *chip, unsigned gpio)
54{
55 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
56
57 bcma_chipco_gpio_control(cc, 1 << gpio, 0);
58 /* clear pulldown */
59 bcma_chipco_gpio_pulldown(cc, 1 << gpio, 0);
60 /* Set pullup */
61 bcma_chipco_gpio_pullup(cc, 1 << gpio, 1 << gpio);
62
63 return 0;
64}
65
66static void bcma_gpio_free(struct gpio_chip *chip, unsigned gpio)
67{
68 struct bcma_drv_cc *cc = gpiochip_get_data(chip);
69
70 /* clear pullup */
71 bcma_chipco_gpio_pullup(cc, 1 << gpio, 0);
72}
73
74#if IS_BUILTIN(CONFIG_BCM47XX) || IS_BUILTIN(CONFIG_ARCH_BCM_5301X)
75
76static void bcma_gpio_irq_unmask(struct irq_data *d)
77{
78 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
79 struct bcma_drv_cc *cc = gpiochip_get_data(gc);
80 int gpio = irqd_to_hwirq(d);
81 u32 val = bcma_chipco_gpio_in(cc, BIT(gpio));
82
83 bcma_chipco_gpio_polarity(cc, BIT(gpio), val);
84 bcma_chipco_gpio_intmask(cc, BIT(gpio), BIT(gpio));
85}
86
87static void bcma_gpio_irq_mask(struct irq_data *d)
88{
89 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
90 struct bcma_drv_cc *cc = gpiochip_get_data(gc);
91 int gpio = irqd_to_hwirq(d);
92
93 bcma_chipco_gpio_intmask(cc, BIT(gpio), 0);
94}
95
96static struct irq_chip bcma_gpio_irq_chip = {
97 .name = "BCMA-GPIO",
98 .irq_mask = bcma_gpio_irq_mask,
99 .irq_unmask = bcma_gpio_irq_unmask,
100};
101
102static irqreturn_t bcma_gpio_irq_handler(int irq, void *dev_id)
103{
104 struct bcma_drv_cc *cc = dev_id;
105 struct gpio_chip *gc = &cc->gpio;
106 u32 val = bcma_cc_read32(cc, BCMA_CC_GPIOIN);
107 u32 mask = bcma_cc_read32(cc, BCMA_CC_GPIOIRQ);
108 u32 pol = bcma_cc_read32(cc, BCMA_CC_GPIOPOL);
109 unsigned long irqs = (val ^ pol) & mask;
110 int gpio;
111
112 if (!irqs)
113 return IRQ_NONE;
114
115 for_each_set_bit(gpio, &irqs, gc->ngpio)
116 generic_handle_irq(irq_find_mapping(gc->irqdomain, gpio));
117 bcma_chipco_gpio_polarity(cc, irqs, val & irqs);
118
119 return IRQ_HANDLED;
120}
121
122static int bcma_gpio_irq_init(struct bcma_drv_cc *cc)
123{
124 struct gpio_chip *chip = &cc->gpio;
125 int hwirq, err;
126
127 if (cc->core->bus->hosttype != BCMA_HOSTTYPE_SOC)
128 return 0;
129
130 hwirq = bcma_core_irq(cc->core, 0);
131 err = request_irq(hwirq, bcma_gpio_irq_handler, IRQF_SHARED, "gpio",
132 cc);
133 if (err)
134 return err;
135
136 bcma_chipco_gpio_intmask(cc, ~0, 0);
137 bcma_cc_set32(cc, BCMA_CC_IRQMASK, BCMA_CC_IRQ_GPIO);
138
139 err = gpiochip_irqchip_add(chip,
140 &bcma_gpio_irq_chip,
141 0,
142 handle_simple_irq,
143 IRQ_TYPE_NONE);
144 if (err) {
145 free_irq(hwirq, cc);
146 return err;
147 }
148
149 return 0;
150}
151
152static void bcma_gpio_irq_exit(struct bcma_drv_cc *cc)
153{
154 if (cc->core->bus->hosttype != BCMA_HOSTTYPE_SOC)
155 return;
156
157 bcma_cc_mask32(cc, BCMA_CC_IRQMASK, ~BCMA_CC_IRQ_GPIO);
158 free_irq(bcma_core_irq(cc->core, 0), cc);
159}
160#else
161static int bcma_gpio_irq_init(struct bcma_drv_cc *cc)
162{
163 return 0;
164}
165
166static void bcma_gpio_irq_exit(struct bcma_drv_cc *cc)
167{
168}
169#endif
170
171int bcma_gpio_init(struct bcma_drv_cc *cc)
172{
173 struct bcma_bus *bus = cc->core->bus;
174 struct gpio_chip *chip = &cc->gpio;
175 int err;
176
177 chip->label = "bcma_gpio";
178 chip->owner = THIS_MODULE;
179 chip->request = bcma_gpio_request;
180 chip->free = bcma_gpio_free;
181 chip->get = bcma_gpio_get_value;
182 chip->set = bcma_gpio_set_value;
183 chip->direction_input = bcma_gpio_direction_input;
184 chip->direction_output = bcma_gpio_direction_output;
185 chip->owner = THIS_MODULE;
186 chip->parent = bcma_bus_get_host_dev(bus);
187#if IS_BUILTIN(CONFIG_OF)
188 if (cc->core->bus->hosttype == BCMA_HOSTTYPE_SOC)
189 chip->of_node = cc->core->dev.of_node;
190#endif
191 switch (bus->chipinfo.id) {
192 case BCMA_CHIP_ID_BCM4707:
193 case BCMA_CHIP_ID_BCM5357:
194 case BCMA_CHIP_ID_BCM53572:
195 case BCMA_CHIP_ID_BCM47094:
196 chip->ngpio = 32;
197 break;
198 default:
199 chip->ngpio = 16;
200 }
201
202 /*
203 * Register SoC GPIO devices with absolute GPIO pin base.
204 * On MIPS, we don't have Device Tree and we can't use relative (per chip)
205 * GPIO numbers.
206 * On some ARM devices, user space may want to access some system GPIO
207 * pins directly, which is easier to do with a predictable GPIO base.
208 */
209 if (IS_BUILTIN(CONFIG_BCM47XX) ||
210 cc->core->bus->hosttype == BCMA_HOSTTYPE_SOC)
211 chip->base = bus->num * BCMA_GPIO_MAX_PINS;
212 else
213 chip->base = -1;
214
215 err = gpiochip_add_data(chip, cc);
216 if (err)
217 return err;
218
219 err = bcma_gpio_irq_init(cc);
220 if (err) {
221 gpiochip_remove(chip);
222 return err;
223 }
224
225 return 0;
226}
227
228int bcma_gpio_unregister(struct bcma_drv_cc *cc)
229{
230 bcma_gpio_irq_exit(cc);
231 gpiochip_remove(&cc->gpio);
232 return 0;
233}