1/*-
2 * Copyright (c) 2009, Oleksandr Tymoshenko <gonzo@FreeBSD.org>
3 * Copyright (c) 2009, Luiz Otavio O Souza.
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice unmodified, this list of conditions, and the following
11 * disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29/*
30 * GPIO driver for AR71xx
31 */
32
33#include <sys/cdefs.h>
| 1/*-
2 * Copyright (c) 2009, Oleksandr Tymoshenko <gonzo@FreeBSD.org>
3 * Copyright (c) 2009, Luiz Otavio O Souza.
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice unmodified, this list of conditions, and the following
11 * disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29/*
30 * GPIO driver for AR71xx
31 */
32
33#include <sys/cdefs.h>
|
35
36#include <sys/param.h>
37#include <sys/systm.h>
38#include <sys/bus.h>
39
40#include <sys/kernel.h>
41#include <sys/module.h>
42#include <sys/rman.h>
43#include <sys/lock.h>
44#include <sys/malloc.h>
45#include <sys/mutex.h>
46#include <sys/gpio.h>
47
48#include <machine/bus.h>
49#include <machine/resource.h>
50#include <mips/atheros/ar71xxreg.h>
51#include <mips/atheros/ar71xx_setup.h>
52#include <mips/atheros/ar71xx_gpiovar.h>
53#include <mips/atheros/ar933xreg.h>
54#include <mips/atheros/ar934xreg.h>
55
56#include "gpio_if.h"
57
58#define DEFAULT_CAPS (GPIO_PIN_INPUT | GPIO_PIN_OUTPUT)
59
60/*
61 * Helpers
62 */
63static void ar71xx_gpio_function_enable(struct ar71xx_gpio_softc *sc,
64 uint32_t mask);
65static void ar71xx_gpio_function_disable(struct ar71xx_gpio_softc *sc,
66 uint32_t mask);
67static void ar71xx_gpio_pin_configure(struct ar71xx_gpio_softc *sc,
68 struct gpio_pin *pin, uint32_t flags);
69
70/*
71 * Driver stuff
72 */
73static int ar71xx_gpio_probe(device_t dev);
74static int ar71xx_gpio_attach(device_t dev);
75static int ar71xx_gpio_detach(device_t dev);
76static int ar71xx_gpio_filter(void *arg);
77static void ar71xx_gpio_intr(void *arg);
78
79/*
80 * GPIO interface
81 */
82static int ar71xx_gpio_pin_max(device_t dev, int *maxpin);
83static int ar71xx_gpio_pin_getcaps(device_t dev, uint32_t pin, uint32_t *caps);
84static int ar71xx_gpio_pin_getflags(device_t dev, uint32_t pin, uint32_t
85 *flags);
86static int ar71xx_gpio_pin_getname(device_t dev, uint32_t pin, char *name);
87static int ar71xx_gpio_pin_setflags(device_t dev, uint32_t pin, uint32_t flags);
88static int ar71xx_gpio_pin_set(device_t dev, uint32_t pin, unsigned int value);
89static int ar71xx_gpio_pin_get(device_t dev, uint32_t pin, unsigned int *val);
90static int ar71xx_gpio_pin_toggle(device_t dev, uint32_t pin);
91
92static void
93ar71xx_gpio_function_enable(struct ar71xx_gpio_softc *sc, uint32_t mask)
94{
95 if (ar71xx_soc == AR71XX_SOC_AR9341 ||
96 ar71xx_soc == AR71XX_SOC_AR9342 ||
97 ar71xx_soc == AR71XX_SOC_AR9344)
98 GPIO_SET_BITS(sc, AR934X_GPIO_REG_FUNC, mask);
99 else
100 GPIO_SET_BITS(sc, AR71XX_GPIO_FUNCTION, mask);
101}
102
103static void
104ar71xx_gpio_function_disable(struct ar71xx_gpio_softc *sc, uint32_t mask)
105{
106 if (ar71xx_soc == AR71XX_SOC_AR9341 ||
107 ar71xx_soc == AR71XX_SOC_AR9342 ||
108 ar71xx_soc == AR71XX_SOC_AR9344)
109 GPIO_CLEAR_BITS(sc, AR934X_GPIO_REG_FUNC, mask);
110 else
111 GPIO_CLEAR_BITS(sc, AR71XX_GPIO_FUNCTION, mask);
112}
113
114static void
115ar71xx_gpio_pin_configure(struct ar71xx_gpio_softc *sc, struct gpio_pin *pin,
116 unsigned int flags)
117{
118 uint32_t mask;
119
120 mask = 1 << pin->gp_pin;
121
122 /*
123 * Manage input/output
124 */
125 if (flags & (GPIO_PIN_INPUT|GPIO_PIN_OUTPUT)) {
126 pin->gp_flags &= ~(GPIO_PIN_INPUT|GPIO_PIN_OUTPUT);
127 if (flags & GPIO_PIN_OUTPUT) {
128 pin->gp_flags |= GPIO_PIN_OUTPUT;
129 GPIO_SET_BITS(sc, AR71XX_GPIO_OE, mask);
130 }
131 else {
132 pin->gp_flags |= GPIO_PIN_INPUT;
133 GPIO_CLEAR_BITS(sc, AR71XX_GPIO_OE, mask);
134 }
135 }
136}
137
138static int
139ar71xx_gpio_pin_max(device_t dev, int *maxpin)
140{
141
142 switch (ar71xx_soc) {
143 case AR71XX_SOC_AR9130:
144 case AR71XX_SOC_AR9132:
145 *maxpin = AR91XX_GPIO_PINS - 1;
146 break;
147 case AR71XX_SOC_AR7240:
148 case AR71XX_SOC_AR7241:
149 case AR71XX_SOC_AR7242:
150 *maxpin = AR724X_GPIO_PINS - 1;
151 break;
152 case AR71XX_SOC_AR9330:
153 case AR71XX_SOC_AR9331:
154 *maxpin = AR933X_GPIO_COUNT - 1;
155 break;
156 case AR71XX_SOC_AR9341:
157 case AR71XX_SOC_AR9342:
158 case AR71XX_SOC_AR9344:
159 *maxpin = AR934X_GPIO_COUNT - 1;
160 break;
161 default:
162 *maxpin = AR71XX_GPIO_PINS - 1;
163 }
164 return (0);
165}
166
167static int
168ar71xx_gpio_pin_getcaps(device_t dev, uint32_t pin, uint32_t *caps)
169{
170 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
171 int i;
172
173 for (i = 0; i < sc->gpio_npins; i++) {
174 if (sc->gpio_pins[i].gp_pin == pin)
175 break;
176 }
177
178 if (i >= sc->gpio_npins)
179 return (EINVAL);
180
181 GPIO_LOCK(sc);
182 *caps = sc->gpio_pins[i].gp_caps;
183 GPIO_UNLOCK(sc);
184
185 return (0);
186}
187
188static int
189ar71xx_gpio_pin_getflags(device_t dev, uint32_t pin, uint32_t *flags)
190{
191 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
192 int i;
193
194 for (i = 0; i < sc->gpio_npins; i++) {
195 if (sc->gpio_pins[i].gp_pin == pin)
196 break;
197 }
198
199 if (i >= sc->gpio_npins)
200 return (EINVAL);
201
202 GPIO_LOCK(sc);
203 *flags = sc->gpio_pins[i].gp_flags;
204 GPIO_UNLOCK(sc);
205
206 return (0);
207}
208
209static int
210ar71xx_gpio_pin_getname(device_t dev, uint32_t pin, char *name)
211{
212 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
213 int i;
214
215 for (i = 0; i < sc->gpio_npins; i++) {
216 if (sc->gpio_pins[i].gp_pin == pin)
217 break;
218 }
219
220 if (i >= sc->gpio_npins)
221 return (EINVAL);
222
223 GPIO_LOCK(sc);
224 memcpy(name, sc->gpio_pins[i].gp_name, GPIOMAXNAME);
225 GPIO_UNLOCK(sc);
226
227 return (0);
228}
229
230static int
231ar71xx_gpio_pin_setflags(device_t dev, uint32_t pin, uint32_t flags)
232{
233 int i;
234 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
235
236 for (i = 0; i < sc->gpio_npins; i++) {
237 if (sc->gpio_pins[i].gp_pin == pin)
238 break;
239 }
240
241 if (i >= sc->gpio_npins)
242 return (EINVAL);
243
| 35
36#include <sys/param.h>
37#include <sys/systm.h>
38#include <sys/bus.h>
39
40#include <sys/kernel.h>
41#include <sys/module.h>
42#include <sys/rman.h>
43#include <sys/lock.h>
44#include <sys/malloc.h>
45#include <sys/mutex.h>
46#include <sys/gpio.h>
47
48#include <machine/bus.h>
49#include <machine/resource.h>
50#include <mips/atheros/ar71xxreg.h>
51#include <mips/atheros/ar71xx_setup.h>
52#include <mips/atheros/ar71xx_gpiovar.h>
53#include <mips/atheros/ar933xreg.h>
54#include <mips/atheros/ar934xreg.h>
55
56#include "gpio_if.h"
57
58#define DEFAULT_CAPS (GPIO_PIN_INPUT | GPIO_PIN_OUTPUT)
59
60/*
61 * Helpers
62 */
63static void ar71xx_gpio_function_enable(struct ar71xx_gpio_softc *sc,
64 uint32_t mask);
65static void ar71xx_gpio_function_disable(struct ar71xx_gpio_softc *sc,
66 uint32_t mask);
67static void ar71xx_gpio_pin_configure(struct ar71xx_gpio_softc *sc,
68 struct gpio_pin *pin, uint32_t flags);
69
70/*
71 * Driver stuff
72 */
73static int ar71xx_gpio_probe(device_t dev);
74static int ar71xx_gpio_attach(device_t dev);
75static int ar71xx_gpio_detach(device_t dev);
76static int ar71xx_gpio_filter(void *arg);
77static void ar71xx_gpio_intr(void *arg);
78
79/*
80 * GPIO interface
81 */
82static int ar71xx_gpio_pin_max(device_t dev, int *maxpin);
83static int ar71xx_gpio_pin_getcaps(device_t dev, uint32_t pin, uint32_t *caps);
84static int ar71xx_gpio_pin_getflags(device_t dev, uint32_t pin, uint32_t
85 *flags);
86static int ar71xx_gpio_pin_getname(device_t dev, uint32_t pin, char *name);
87static int ar71xx_gpio_pin_setflags(device_t dev, uint32_t pin, uint32_t flags);
88static int ar71xx_gpio_pin_set(device_t dev, uint32_t pin, unsigned int value);
89static int ar71xx_gpio_pin_get(device_t dev, uint32_t pin, unsigned int *val);
90static int ar71xx_gpio_pin_toggle(device_t dev, uint32_t pin);
91
92static void
93ar71xx_gpio_function_enable(struct ar71xx_gpio_softc *sc, uint32_t mask)
94{
95 if (ar71xx_soc == AR71XX_SOC_AR9341 ||
96 ar71xx_soc == AR71XX_SOC_AR9342 ||
97 ar71xx_soc == AR71XX_SOC_AR9344)
98 GPIO_SET_BITS(sc, AR934X_GPIO_REG_FUNC, mask);
99 else
100 GPIO_SET_BITS(sc, AR71XX_GPIO_FUNCTION, mask);
101}
102
103static void
104ar71xx_gpio_function_disable(struct ar71xx_gpio_softc *sc, uint32_t mask)
105{
106 if (ar71xx_soc == AR71XX_SOC_AR9341 ||
107 ar71xx_soc == AR71XX_SOC_AR9342 ||
108 ar71xx_soc == AR71XX_SOC_AR9344)
109 GPIO_CLEAR_BITS(sc, AR934X_GPIO_REG_FUNC, mask);
110 else
111 GPIO_CLEAR_BITS(sc, AR71XX_GPIO_FUNCTION, mask);
112}
113
114static void
115ar71xx_gpio_pin_configure(struct ar71xx_gpio_softc *sc, struct gpio_pin *pin,
116 unsigned int flags)
117{
118 uint32_t mask;
119
120 mask = 1 << pin->gp_pin;
121
122 /*
123 * Manage input/output
124 */
125 if (flags & (GPIO_PIN_INPUT|GPIO_PIN_OUTPUT)) {
126 pin->gp_flags &= ~(GPIO_PIN_INPUT|GPIO_PIN_OUTPUT);
127 if (flags & GPIO_PIN_OUTPUT) {
128 pin->gp_flags |= GPIO_PIN_OUTPUT;
129 GPIO_SET_BITS(sc, AR71XX_GPIO_OE, mask);
130 }
131 else {
132 pin->gp_flags |= GPIO_PIN_INPUT;
133 GPIO_CLEAR_BITS(sc, AR71XX_GPIO_OE, mask);
134 }
135 }
136}
137
138static int
139ar71xx_gpio_pin_max(device_t dev, int *maxpin)
140{
141
142 switch (ar71xx_soc) {
143 case AR71XX_SOC_AR9130:
144 case AR71XX_SOC_AR9132:
145 *maxpin = AR91XX_GPIO_PINS - 1;
146 break;
147 case AR71XX_SOC_AR7240:
148 case AR71XX_SOC_AR7241:
149 case AR71XX_SOC_AR7242:
150 *maxpin = AR724X_GPIO_PINS - 1;
151 break;
152 case AR71XX_SOC_AR9330:
153 case AR71XX_SOC_AR9331:
154 *maxpin = AR933X_GPIO_COUNT - 1;
155 break;
156 case AR71XX_SOC_AR9341:
157 case AR71XX_SOC_AR9342:
158 case AR71XX_SOC_AR9344:
159 *maxpin = AR934X_GPIO_COUNT - 1;
160 break;
161 default:
162 *maxpin = AR71XX_GPIO_PINS - 1;
163 }
164 return (0);
165}
166
167static int
168ar71xx_gpio_pin_getcaps(device_t dev, uint32_t pin, uint32_t *caps)
169{
170 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
171 int i;
172
173 for (i = 0; i < sc->gpio_npins; i++) {
174 if (sc->gpio_pins[i].gp_pin == pin)
175 break;
176 }
177
178 if (i >= sc->gpio_npins)
179 return (EINVAL);
180
181 GPIO_LOCK(sc);
182 *caps = sc->gpio_pins[i].gp_caps;
183 GPIO_UNLOCK(sc);
184
185 return (0);
186}
187
188static int
189ar71xx_gpio_pin_getflags(device_t dev, uint32_t pin, uint32_t *flags)
190{
191 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
192 int i;
193
194 for (i = 0; i < sc->gpio_npins; i++) {
195 if (sc->gpio_pins[i].gp_pin == pin)
196 break;
197 }
198
199 if (i >= sc->gpio_npins)
200 return (EINVAL);
201
202 GPIO_LOCK(sc);
203 *flags = sc->gpio_pins[i].gp_flags;
204 GPIO_UNLOCK(sc);
205
206 return (0);
207}
208
209static int
210ar71xx_gpio_pin_getname(device_t dev, uint32_t pin, char *name)
211{
212 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
213 int i;
214
215 for (i = 0; i < sc->gpio_npins; i++) {
216 if (sc->gpio_pins[i].gp_pin == pin)
217 break;
218 }
219
220 if (i >= sc->gpio_npins)
221 return (EINVAL);
222
223 GPIO_LOCK(sc);
224 memcpy(name, sc->gpio_pins[i].gp_name, GPIOMAXNAME);
225 GPIO_UNLOCK(sc);
226
227 return (0);
228}
229
230static int
231ar71xx_gpio_pin_setflags(device_t dev, uint32_t pin, uint32_t flags)
232{
233 int i;
234 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
235
236 for (i = 0; i < sc->gpio_npins; i++) {
237 if (sc->gpio_pins[i].gp_pin == pin)
238 break;
239 }
240
241 if (i >= sc->gpio_npins)
242 return (EINVAL);
243
|
254 return (0);
255}
256
257static int
258ar71xx_gpio_pin_set(device_t dev, uint32_t pin, unsigned int value)
259{
260 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
261 int i;
262
263 for (i = 0; i < sc->gpio_npins; i++) {
264 if (sc->gpio_pins[i].gp_pin == pin)
265 break;
266 }
267
268 if (i >= sc->gpio_npins)
269 return (EINVAL);
270
271 if (value)
272 GPIO_WRITE(sc, AR71XX_GPIO_SET, (1 << pin));
273 else
274 GPIO_WRITE(sc, AR71XX_GPIO_CLEAR, (1 << pin));
275
276 return (0);
277}
278
279static int
280ar71xx_gpio_pin_get(device_t dev, uint32_t pin, unsigned int *val)
281{
282 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
283 int i;
284
285 for (i = 0; i < sc->gpio_npins; i++) {
286 if (sc->gpio_pins[i].gp_pin == pin)
287 break;
288 }
289
290 if (i >= sc->gpio_npins)
291 return (EINVAL);
292
293 *val = (GPIO_READ(sc, AR71XX_GPIO_IN) & (1 << pin)) ? 1 : 0;
294
295 return (0);
296}
297
298static int
299ar71xx_gpio_pin_toggle(device_t dev, uint32_t pin)
300{
301 int res, i;
302 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
303
304 for (i = 0; i < sc->gpio_npins; i++) {
305 if (sc->gpio_pins[i].gp_pin == pin)
306 break;
307 }
308
309 if (i >= sc->gpio_npins)
310 return (EINVAL);
311
312 res = (GPIO_READ(sc, AR71XX_GPIO_IN) & (1 << pin)) ? 1 : 0;
313 if (res)
314 GPIO_WRITE(sc, AR71XX_GPIO_CLEAR, (1 << pin));
315 else
316 GPIO_WRITE(sc, AR71XX_GPIO_SET, (1 << pin));
317
318 return (0);
319}
320
321static int
322ar71xx_gpio_filter(void *arg)
323{
324
325 /* TODO: something useful */
326 return (FILTER_STRAY);
327}
328
329
330
331static void
332ar71xx_gpio_intr(void *arg)
333{
334 struct ar71xx_gpio_softc *sc = arg;
335 GPIO_LOCK(sc);
336 /* TODO: something useful */
337 GPIO_UNLOCK(sc);
338}
339
340static int
341ar71xx_gpio_probe(device_t dev)
342{
343
344 device_set_desc(dev, "Atheros AR71XX GPIO driver");
345 return (0);
346}
347
348static int
349ar71xx_gpio_attach(device_t dev)
350{
351 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
352 int error = 0;
353 int i, j, maxpin;
354 int mask, pinon;
355 uint32_t oe;
356
357 KASSERT((device_get_unit(dev) == 0),
358 ("ar71xx_gpio: Only one gpio module supported"));
359
360 mtx_init(&sc->gpio_mtx, device_get_nameunit(dev), NULL, MTX_DEF);
361
362 /* Map control/status registers. */
363 sc->gpio_mem_rid = 0;
364 sc->gpio_mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
365 &sc->gpio_mem_rid, RF_ACTIVE);
366
367 if (sc->gpio_mem_res == NULL) {
368 device_printf(dev, "couldn't map memory\n");
369 error = ENXIO;
370 ar71xx_gpio_detach(dev);
371 return(error);
372 }
373
374 if ((sc->gpio_irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ,
375 &sc->gpio_irq_rid, RF_SHAREABLE | RF_ACTIVE)) == NULL) {
376 device_printf(dev, "unable to allocate IRQ resource\n");
377 return (ENXIO);
378 }
379
380 if ((bus_setup_intr(dev, sc->gpio_irq_res, INTR_TYPE_MISC,
381 ar71xx_gpio_filter, ar71xx_gpio_intr, sc, &sc->gpio_ih))) {
382 device_printf(dev,
383 "WARNING: unable to register interrupt handler\n");
384 return (ENXIO);
385 }
386
387 sc->dev = dev;
388
389 /* Enable function bits that are required */
390 if (resource_int_value(device_get_name(dev), device_get_unit(dev),
391 "function_set", &mask) == 0) {
392 device_printf(dev, "function_set: 0x%x\n", mask);
393 ar71xx_gpio_function_enable(sc, mask);
394 }
395 /* Disable function bits that are required */
396 if (resource_int_value(device_get_name(dev), device_get_unit(dev),
397 "function_clear", &mask) == 0) {
398 device_printf(dev, "function_clear: 0x%x\n", mask);
399 ar71xx_gpio_function_disable(sc, mask);
400 }
401
402 /* Disable interrupts for all pins. */
403 GPIO_WRITE(sc, AR71XX_GPIO_INT_MASK, 0);
404
405 /* Initialise all pins specified in the mask, up to the pin count */
406 (void) ar71xx_gpio_pin_max(dev, &maxpin);
407 if (resource_int_value(device_get_name(dev), device_get_unit(dev),
408 "pinmask", &mask) != 0)
409 mask = 0;
410 if (resource_int_value(device_get_name(dev), device_get_unit(dev),
411 "pinon", &pinon) != 0)
412 pinon = 0;
413 device_printf(dev, "gpio pinmask=0x%x\n", mask);
414 for (j = 0; j <= maxpin; j++) {
415 if ((mask & (1 << j)) == 0)
416 continue;
417 sc->gpio_npins++;
418 }
419 /* Iniatilize the GPIO pins, keep the loader settings. */
420 oe = GPIO_READ(sc, AR71XX_GPIO_OE);
421 sc->gpio_pins = malloc(sizeof(*sc->gpio_pins) * sc->gpio_npins,
422 M_DEVBUF, M_WAITOK | M_ZERO);
423 for (i = 0, j = 0; j <= maxpin; j++) {
424 if ((mask & (1 << j)) == 0)
425 continue;
426 snprintf(sc->gpio_pins[i].gp_name, GPIOMAXNAME,
427 "pin %d", j);
428 sc->gpio_pins[i].gp_pin = j;
429 sc->gpio_pins[i].gp_caps = DEFAULT_CAPS;
430 if (oe & (1 << j))
431 sc->gpio_pins[i].gp_flags = GPIO_PIN_OUTPUT;
432 else
433 sc->gpio_pins[i].gp_flags = GPIO_PIN_INPUT;
434 i++;
435 }
436 /* Turn on the hinted pins. */
437 for (i = 0; i < sc->gpio_npins; i++) {
438 j = sc->gpio_pins[i].gp_pin;
439 if ((pinon & (1 << j)) != 0) {
440 ar71xx_gpio_pin_setflags(dev, j, GPIO_PIN_OUTPUT);
441 ar71xx_gpio_pin_set(dev, j, 1);
442 }
443 }
444 device_add_child(dev, "gpioc", -1);
445 device_add_child(dev, "gpiobus", -1);
446
447 return (bus_generic_attach(dev));
448}
449
450static int
451ar71xx_gpio_detach(device_t dev)
452{
453 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
454
455 KASSERT(mtx_initialized(&sc->gpio_mtx), ("gpio mutex not initialized"));
456
457 bus_generic_detach(dev);
458
459 if (sc->gpio_mem_res)
460 bus_release_resource(dev, SYS_RES_MEMORY, sc->gpio_mem_rid,
461 sc->gpio_mem_res);
462
463 free(sc->gpio_pins, M_DEVBUF);
464 mtx_destroy(&sc->gpio_mtx);
465
466 return(0);
467}
468
469static device_method_t ar71xx_gpio_methods[] = {
470 DEVMETHOD(device_probe, ar71xx_gpio_probe),
471 DEVMETHOD(device_attach, ar71xx_gpio_attach),
472 DEVMETHOD(device_detach, ar71xx_gpio_detach),
473
474 /* GPIO protocol */
475 DEVMETHOD(gpio_pin_max, ar71xx_gpio_pin_max),
476 DEVMETHOD(gpio_pin_getname, ar71xx_gpio_pin_getname),
477 DEVMETHOD(gpio_pin_getflags, ar71xx_gpio_pin_getflags),
478 DEVMETHOD(gpio_pin_getcaps, ar71xx_gpio_pin_getcaps),
479 DEVMETHOD(gpio_pin_setflags, ar71xx_gpio_pin_setflags),
480 DEVMETHOD(gpio_pin_get, ar71xx_gpio_pin_get),
481 DEVMETHOD(gpio_pin_set, ar71xx_gpio_pin_set),
482 DEVMETHOD(gpio_pin_toggle, ar71xx_gpio_pin_toggle),
483 {0, 0},
484};
485
486static driver_t ar71xx_gpio_driver = {
487 "gpio",
488 ar71xx_gpio_methods,
489 sizeof(struct ar71xx_gpio_softc),
490};
491static devclass_t ar71xx_gpio_devclass;
492
493DRIVER_MODULE(ar71xx_gpio, apb, ar71xx_gpio_driver, ar71xx_gpio_devclass, 0, 0);
| 246 return (0);
247}
248
249static int
250ar71xx_gpio_pin_set(device_t dev, uint32_t pin, unsigned int value)
251{
252 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
253 int i;
254
255 for (i = 0; i < sc->gpio_npins; i++) {
256 if (sc->gpio_pins[i].gp_pin == pin)
257 break;
258 }
259
260 if (i >= sc->gpio_npins)
261 return (EINVAL);
262
263 if (value)
264 GPIO_WRITE(sc, AR71XX_GPIO_SET, (1 << pin));
265 else
266 GPIO_WRITE(sc, AR71XX_GPIO_CLEAR, (1 << pin));
267
268 return (0);
269}
270
271static int
272ar71xx_gpio_pin_get(device_t dev, uint32_t pin, unsigned int *val)
273{
274 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
275 int i;
276
277 for (i = 0; i < sc->gpio_npins; i++) {
278 if (sc->gpio_pins[i].gp_pin == pin)
279 break;
280 }
281
282 if (i >= sc->gpio_npins)
283 return (EINVAL);
284
285 *val = (GPIO_READ(sc, AR71XX_GPIO_IN) & (1 << pin)) ? 1 : 0;
286
287 return (0);
288}
289
290static int
291ar71xx_gpio_pin_toggle(device_t dev, uint32_t pin)
292{
293 int res, i;
294 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
295
296 for (i = 0; i < sc->gpio_npins; i++) {
297 if (sc->gpio_pins[i].gp_pin == pin)
298 break;
299 }
300
301 if (i >= sc->gpio_npins)
302 return (EINVAL);
303
304 res = (GPIO_READ(sc, AR71XX_GPIO_IN) & (1 << pin)) ? 1 : 0;
305 if (res)
306 GPIO_WRITE(sc, AR71XX_GPIO_CLEAR, (1 << pin));
307 else
308 GPIO_WRITE(sc, AR71XX_GPIO_SET, (1 << pin));
309
310 return (0);
311}
312
313static int
314ar71xx_gpio_filter(void *arg)
315{
316
317 /* TODO: something useful */
318 return (FILTER_STRAY);
319}
320
321
322
323static void
324ar71xx_gpio_intr(void *arg)
325{
326 struct ar71xx_gpio_softc *sc = arg;
327 GPIO_LOCK(sc);
328 /* TODO: something useful */
329 GPIO_UNLOCK(sc);
330}
331
332static int
333ar71xx_gpio_probe(device_t dev)
334{
335
336 device_set_desc(dev, "Atheros AR71XX GPIO driver");
337 return (0);
338}
339
340static int
341ar71xx_gpio_attach(device_t dev)
342{
343 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
344 int error = 0;
345 int i, j, maxpin;
346 int mask, pinon;
347 uint32_t oe;
348
349 KASSERT((device_get_unit(dev) == 0),
350 ("ar71xx_gpio: Only one gpio module supported"));
351
352 mtx_init(&sc->gpio_mtx, device_get_nameunit(dev), NULL, MTX_DEF);
353
354 /* Map control/status registers. */
355 sc->gpio_mem_rid = 0;
356 sc->gpio_mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
357 &sc->gpio_mem_rid, RF_ACTIVE);
358
359 if (sc->gpio_mem_res == NULL) {
360 device_printf(dev, "couldn't map memory\n");
361 error = ENXIO;
362 ar71xx_gpio_detach(dev);
363 return(error);
364 }
365
366 if ((sc->gpio_irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ,
367 &sc->gpio_irq_rid, RF_SHAREABLE | RF_ACTIVE)) == NULL) {
368 device_printf(dev, "unable to allocate IRQ resource\n");
369 return (ENXIO);
370 }
371
372 if ((bus_setup_intr(dev, sc->gpio_irq_res, INTR_TYPE_MISC,
373 ar71xx_gpio_filter, ar71xx_gpio_intr, sc, &sc->gpio_ih))) {
374 device_printf(dev,
375 "WARNING: unable to register interrupt handler\n");
376 return (ENXIO);
377 }
378
379 sc->dev = dev;
380
381 /* Enable function bits that are required */
382 if (resource_int_value(device_get_name(dev), device_get_unit(dev),
383 "function_set", &mask) == 0) {
384 device_printf(dev, "function_set: 0x%x\n", mask);
385 ar71xx_gpio_function_enable(sc, mask);
386 }
387 /* Disable function bits that are required */
388 if (resource_int_value(device_get_name(dev), device_get_unit(dev),
389 "function_clear", &mask) == 0) {
390 device_printf(dev, "function_clear: 0x%x\n", mask);
391 ar71xx_gpio_function_disable(sc, mask);
392 }
393
394 /* Disable interrupts for all pins. */
395 GPIO_WRITE(sc, AR71XX_GPIO_INT_MASK, 0);
396
397 /* Initialise all pins specified in the mask, up to the pin count */
398 (void) ar71xx_gpio_pin_max(dev, &maxpin);
399 if (resource_int_value(device_get_name(dev), device_get_unit(dev),
400 "pinmask", &mask) != 0)
401 mask = 0;
402 if (resource_int_value(device_get_name(dev), device_get_unit(dev),
403 "pinon", &pinon) != 0)
404 pinon = 0;
405 device_printf(dev, "gpio pinmask=0x%x\n", mask);
406 for (j = 0; j <= maxpin; j++) {
407 if ((mask & (1 << j)) == 0)
408 continue;
409 sc->gpio_npins++;
410 }
411 /* Iniatilize the GPIO pins, keep the loader settings. */
412 oe = GPIO_READ(sc, AR71XX_GPIO_OE);
413 sc->gpio_pins = malloc(sizeof(*sc->gpio_pins) * sc->gpio_npins,
414 M_DEVBUF, M_WAITOK | M_ZERO);
415 for (i = 0, j = 0; j <= maxpin; j++) {
416 if ((mask & (1 << j)) == 0)
417 continue;
418 snprintf(sc->gpio_pins[i].gp_name, GPIOMAXNAME,
419 "pin %d", j);
420 sc->gpio_pins[i].gp_pin = j;
421 sc->gpio_pins[i].gp_caps = DEFAULT_CAPS;
422 if (oe & (1 << j))
423 sc->gpio_pins[i].gp_flags = GPIO_PIN_OUTPUT;
424 else
425 sc->gpio_pins[i].gp_flags = GPIO_PIN_INPUT;
426 i++;
427 }
428 /* Turn on the hinted pins. */
429 for (i = 0; i < sc->gpio_npins; i++) {
430 j = sc->gpio_pins[i].gp_pin;
431 if ((pinon & (1 << j)) != 0) {
432 ar71xx_gpio_pin_setflags(dev, j, GPIO_PIN_OUTPUT);
433 ar71xx_gpio_pin_set(dev, j, 1);
434 }
435 }
436 device_add_child(dev, "gpioc", -1);
437 device_add_child(dev, "gpiobus", -1);
438
439 return (bus_generic_attach(dev));
440}
441
442static int
443ar71xx_gpio_detach(device_t dev)
444{
445 struct ar71xx_gpio_softc *sc = device_get_softc(dev);
446
447 KASSERT(mtx_initialized(&sc->gpio_mtx), ("gpio mutex not initialized"));
448
449 bus_generic_detach(dev);
450
451 if (sc->gpio_mem_res)
452 bus_release_resource(dev, SYS_RES_MEMORY, sc->gpio_mem_rid,
453 sc->gpio_mem_res);
454
455 free(sc->gpio_pins, M_DEVBUF);
456 mtx_destroy(&sc->gpio_mtx);
457
458 return(0);
459}
460
461static device_method_t ar71xx_gpio_methods[] = {
462 DEVMETHOD(device_probe, ar71xx_gpio_probe),
463 DEVMETHOD(device_attach, ar71xx_gpio_attach),
464 DEVMETHOD(device_detach, ar71xx_gpio_detach),
465
466 /* GPIO protocol */
467 DEVMETHOD(gpio_pin_max, ar71xx_gpio_pin_max),
468 DEVMETHOD(gpio_pin_getname, ar71xx_gpio_pin_getname),
469 DEVMETHOD(gpio_pin_getflags, ar71xx_gpio_pin_getflags),
470 DEVMETHOD(gpio_pin_getcaps, ar71xx_gpio_pin_getcaps),
471 DEVMETHOD(gpio_pin_setflags, ar71xx_gpio_pin_setflags),
472 DEVMETHOD(gpio_pin_get, ar71xx_gpio_pin_get),
473 DEVMETHOD(gpio_pin_set, ar71xx_gpio_pin_set),
474 DEVMETHOD(gpio_pin_toggle, ar71xx_gpio_pin_toggle),
475 {0, 0},
476};
477
478static driver_t ar71xx_gpio_driver = {
479 "gpio",
480 ar71xx_gpio_methods,
481 sizeof(struct ar71xx_gpio_softc),
482};
483static devclass_t ar71xx_gpio_devclass;
484
485DRIVER_MODULE(ar71xx_gpio, apb, ar71xx_gpio_driver, ar71xx_gpio_devclass, 0, 0);
|