soekrisgpio.c revision 1.5 
1/*	from $OpenBSD$ */
2
3/*
4 * ported to NetBSD by Frank Kardel
5 * (http://permalink.gmane.org/gmane.os.openbsd.tech/31317)
6 *
7 * Copyright (c) 2013 Matt Dainty <matt <at> bodgit-n-scarper.com>
8 *
9 * Permission to use, copy, modify, and distribute this software for any
10 * purpose with or without fee is hereby granted, provided that the above
11 * copyright notice and this permission notice appear in all copies.
12 *
13 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
14 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
15 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
16 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
17 * WHATSOEVER RESULTING FROM LOSS OF MIND, USE, DATA OR PROFITS, WHETHER IN
18 * AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT
19 * OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
20 */
21
22/*
23 * Soekris net6501 GPIO and LEDs as implemented by the onboard Xilinx FPGA
24 */
25
26#include <sys/cdefs.h>
27__KERNEL_RCSID(0, "$NetBSD: soekrisgpio.c,v 1.5 2021/08/07 16:19:12 thorpej Exp $");
28
29#include <sys/param.h>
30#include <sys/systm.h>
31#include <sys/types.h>
32#include <sys/device.h>
33
34#include <sys/bus.h>
35#include <machine/autoconf.h>
36
37#include <dev/isa/isavar.h>
38
39#include <sys/gpio.h>
40#include <dev/gpio/gpiovar.h>
41
42#include "gpio.h"
43
44#define	SOEKRIS_BASE		0x680	/* Base address of FPGA I/O */
45#define	SOEKRIS_IOSIZE		32	/* I/O region size */
46
47#define	SOEKRIS_NPINS		16	/* Number of Pins */
48#define	SOEKRIS_GPIO_INPUT	0x000	/* Current state of pins */
49#define	SOEKRIS_GPIO_OUTPUT	0x004	/* Set state of output pins */
50#define	SOEKRIS_GPIO_RESET	0x008	/* Reset output pins */
51#define	SOEKRIS_GPIO_SET	0x00c	/* Set output pins */
52#define	SOEKRIS_GPIO_DIR	0x010	/* Direction, set for output */
53
54#define	SOEKRIS_NLEDS		2	/* Number of LEDs */
55#define	SOEKRIS_LED_ERROR	0x01c	/* Offset to error LED */
56#define	SOEKRIS_LED_READY	0x01d	/* Offset to ready LED */
57
58const u_int soekris_led_offset[SOEKRIS_NLEDS] = {
59	SOEKRIS_LED_ERROR, SOEKRIS_LED_READY
60};
61
62struct soekris_softc {
63	device_t		 sc_dev;
64
65	bus_space_tag_t		 sc_iot;
66	bus_space_handle_t	 sc_ioh;
67
68	struct gpio_chipset_tag	 sc_gpio_gc;
69	gpio_pin_t		 sc_gpio_pins[SOEKRIS_NPINS];
70
71	/* Fake GPIO device for the LEDs */
72	struct gpio_chipset_tag	 sc_led_gc;
73	gpio_pin_t		 sc_led_pins[SOEKRIS_NLEDS];
74};
75
76static int	 soekris_match(device_t, cfdata_t , void *);
77static void	 soekris_attach(device_t, device_t, void *);
78static int	 soekris_detach(device_t, int);
79static int	 soekris_gpio_read(void *, int);
80static void	 soekris_gpio_write(void *, int, int);
81static void	 soekris_gpio_ctl(void *, int, int);
82static int	 soekris_led_read(void *, int);
83static void	 soekris_led_write(void *, int, int);
84static void	 soekris_led_ctl(void *, int, int);
85
86CFATTACH_DECL_NEW(soekrisgpio,
87		  sizeof(struct soekris_softc),
88		  soekris_match,
89		  soekris_attach,
90		  soekris_detach,
91		  NULL);
92
93static int
94soekris_match(device_t parent, cfdata_t match, void *aux)
95{
96	struct isa_attach_args *ia = aux;
97	bus_space_handle_t ioh;
98	int iobase;
99
100	if (ia->ia_nio < 1)
101		return (0);
102
103	/* Disallow wildcarded i/o address. */
104	if (ia->ia_io[0].ir_addr == ISA_UNKNOWN_PORT)
105		return (0);
106
107	iobase = ia->ia_io[0].ir_addr;
108
109	/* Need some sort of heuristic to match the Soekris net6501 */
110
111	if (iobase != SOEKRIS_BASE || bus_space_map(ia->ia_iot,
112	    iobase, SOEKRIS_IOSIZE, 0, &ioh) != 0)
113		return (0);
114
115	bus_space_unmap(ia->ia_iot, ioh, SOEKRIS_IOSIZE);
116
117	ia->ia_io[0].ir_size = SOEKRIS_IOSIZE;
118
119	return (1);
120}
121
122static void
123soekris_attach(device_t parent, device_t self, void *aux)
124{
125	struct soekris_softc *sc = device_private(self);
126	struct isa_attach_args *ia = aux;
127	struct gpiobus_attach_args gba1, gba2;
128	u_int data;
129	int i;
130
131	if (bus_space_map(ia->ia_iot, ia->ia_io[0].ir_addr,
132	    ia->ia_io[0].ir_size, 0, &sc->sc_ioh) != 0) {
133		aprint_normal(": can't map i/o space\n");
134		return;
135	}
136
137	aprint_normal("\n");
138
139	sc->sc_dev = self;
140	sc->sc_iot = ia->ia_iot;
141
142	data = bus_space_read_2(sc->sc_iot, sc->sc_ioh, SOEKRIS_GPIO_DIR);
143
144	for (i = 0; i < SOEKRIS_NPINS; i++) {
145		sc->sc_gpio_pins[i].pin_num = i;
146		sc->sc_gpio_pins[i].pin_caps = GPIO_PIN_INPUT |
147		    GPIO_PIN_OUTPUT;
148		sc->sc_gpio_pins[i].pin_flags = (data & (1 << i)) ?
149		    GPIO_PIN_OUTPUT : GPIO_PIN_INPUT;
150		sc->sc_gpio_pins[i].pin_state = soekris_gpio_read(sc, i);
151	}
152
153	sc->sc_gpio_gc.gp_cookie = sc;
154	sc->sc_gpio_gc.gp_pin_read = soekris_gpio_read;
155	sc->sc_gpio_gc.gp_pin_write = soekris_gpio_write;
156	sc->sc_gpio_gc.gp_pin_ctl = soekris_gpio_ctl;
157
158	gba1.gba_gc = &sc->sc_gpio_gc;
159	gba1.gba_pins = sc->sc_gpio_pins;
160	gba1.gba_npins = SOEKRIS_NPINS;
161
162	for (i = 0; i < SOEKRIS_NLEDS; i++) {
163		sc->sc_led_pins[i].pin_num = i;
164		sc->sc_led_pins[i].pin_caps = GPIO_PIN_OUTPUT;
165		sc->sc_led_pins[i].pin_flags = GPIO_PIN_OUTPUT;
166		sc->sc_led_pins[i].pin_state = soekris_led_read(sc, i);
167	}
168
169	sc->sc_led_gc.gp_cookie = sc;
170	sc->sc_led_gc.gp_pin_read = soekris_led_read;
171	sc->sc_led_gc.gp_pin_write = soekris_led_write;
172	sc->sc_led_gc.gp_pin_ctl = soekris_led_ctl;
173
174	gba2.gba_gc = &sc->sc_led_gc;
175	gba2.gba_pins = sc->sc_led_pins;
176	gba2.gba_npins = SOEKRIS_NLEDS;
177
178#if NGPIO > 0
179	(void)config_found(sc->sc_dev, &gba1, gpiobus_print, CFARGS_NONE);
180	(void)config_found(sc->sc_dev, &gba2, gpiobus_print, CFARGS_NONE);
181#endif
182}
183
184static int
185soekris_detach(device_t self, int flags)
186{
187	struct soekris_softc *sc = device_private(self);
188
189	bus_space_unmap(sc->sc_iot, sc->sc_ioh, SOEKRIS_IOSIZE);
190	return 0;
191}
192
193static int
194soekris_gpio_read(void *arg, int pin)
195{
196	struct soekris_softc *sc = arg;
197	u_int16_t data;
198
199	data = bus_space_read_2(sc->sc_iot, sc->sc_ioh, SOEKRIS_GPIO_INPUT);
200
201	return (data & (1 << pin)) ? GPIO_PIN_HIGH : GPIO_PIN_LOW;
202}
203
204static void
205soekris_gpio_write(void *arg, int pin, int value)
206{
207	struct soekris_softc *sc = arg;
208	u_int16_t data;
209
210	data = bus_space_read_2(sc->sc_iot, sc->sc_ioh, SOEKRIS_GPIO_INPUT);
211
212	if (value == GPIO_PIN_LOW)
213		data &= ~(1 << pin);
214	else if (value == GPIO_PIN_HIGH)
215		data |= (1 << pin);
216
217	bus_space_write_2(sc->sc_iot, sc->sc_ioh, SOEKRIS_GPIO_OUTPUT, data);
218}
219
220static void
221soekris_gpio_ctl(void *arg, int pin, int flags)
222{
223	struct soekris_softc *sc = arg;
224	u_int16_t data;
225
226	data = bus_space_read_2(sc->sc_iot, sc->sc_ioh, SOEKRIS_GPIO_DIR);
227
228	if (flags & GPIO_PIN_INPUT)
229		data &= ~(1 << pin);
230	if (flags & GPIO_PIN_OUTPUT)
231		data |= (1 << pin);
232
233	bus_space_write_2(sc->sc_iot, sc->sc_ioh, SOEKRIS_GPIO_DIR, data);
234}
235
236static int
237soekris_led_read(void *arg, int pin)
238{
239	struct soekris_softc *sc = arg;
240	u_int8_t value;
241
242	value = bus_space_read_1(sc->sc_iot, sc->sc_ioh,
243	    soekris_led_offset[pin]);
244
245	return (value & 0x1) ? GPIO_PIN_HIGH : GPIO_PIN_LOW;
246}
247
248static void
249soekris_led_write(void *arg, int pin, int value)
250{
251	struct soekris_softc *sc = arg;
252
253	bus_space_write_1(sc->sc_iot, sc->sc_ioh, soekris_led_offset[pin],
254	    value);
255}
256
257static void
258soekris_led_ctl(void *arg, int pin, int flags)
259{
260}
261