pxa_smi.c revision 227293 
1/*-
2 * Copyright (c) 2006 Benno Rice.  All rights reserved.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions
6 * are met:
7 * 1. Redistributions of source code must retain the above copyright
8 *    notice, this list of conditions and the following disclaimer.
9 * 2. Redistributions in binary form must reproduce the above copyright
10 *    notice, this list of conditions and the following disclaimer in the
11 *    documentation and/or other materials provided with the distribution.
12 *
13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
14 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
15 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
16 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
17 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
18 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
19 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
20 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
21 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
22 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
23 */
24
25#include <sys/cdefs.h>
26__FBSDID("$FreeBSD: head/sys/arm/xscale/pxa/pxa_smi.c 227293 2011-11-07 06:44:47Z ed $");
27
28#include <sys/param.h>
29#include <sys/systm.h>
30#include <sys/bus.h>
31#include <sys/kernel.h>
32#include <sys/module.h>
33#include <sys/malloc.h>
34#include <sys/rman.h>
35#include <sys/timetc.h>
36#include <machine/bus.h>
37#include <machine/intr.h>
38
39#include <vm/vm.h>
40#include <vm/pmap.h>
41
42#include <arm/xscale/pxa/pxavar.h>
43#include <arm/xscale/pxa/pxareg.h>
44
45static MALLOC_DEFINE(M_PXASMI, "PXA SMI",
46    "Data for static memory interface devices.");
47
48struct pxa_smi_softc {
49	struct resource	*ps_res[1];
50	struct rman	ps_mem;
51	bus_space_tag_t	ps_bst;
52	bus_addr_t	ps_base;
53};
54
55struct smi_ivars {
56	struct resource_list	smid_resources;
57	bus_addr_t		smid_mem;
58};
59
60static struct resource_spec pxa_smi_spec[] = {
61	{ SYS_RES_MEMORY,	0,	RF_ACTIVE },
62	{ -1, 0 }
63};
64
65static int	pxa_smi_probe(device_t);
66static int	pxa_smi_attach(device_t);
67
68static int	pxa_smi_print_child(device_t, device_t);
69
70static int	pxa_smi_read_ivar(device_t, device_t, int, uintptr_t *);
71
72static struct resource *	pxa_smi_alloc_resource(device_t, device_t,
73				    int, int *, u_long, u_long, u_long, u_int);
74static int			pxa_smi_release_resource(device_t, device_t,
75				    int, int, struct resource *);
76static int			pxa_smi_activate_resource(device_t, device_t,
77				    int, int, struct resource *);
78
79static void	pxa_smi_add_device(device_t, const char *, int);
80
81static int
82pxa_smi_probe(device_t dev)
83{
84
85	if (resource_disabled("smi", device_get_unit(dev)))
86		return (ENXIO);
87
88	device_set_desc(dev, "Static Memory Interface");
89	return (0);
90}
91
92static int
93pxa_smi_attach(device_t dev)
94{
95	int		error, i, dunit;
96	const char	*dname;
97	struct		pxa_smi_softc *sc;
98
99	sc = (struct pxa_smi_softc *)device_get_softc(dev);
100
101	error = bus_alloc_resources(dev, pxa_smi_spec, sc->ps_res);
102	if (error) {
103		device_printf(dev, "could not allocate resources\n");
104		return (ENXIO);
105	}
106
107	sc->ps_mem.rm_type = RMAN_ARRAY;
108	sc->ps_mem.rm_descr = device_get_nameunit(dev);
109	if (rman_init(&sc->ps_mem) != 0)
110		panic("pxa_smi_attach: failed to init mem rman");
111	if (rman_manage_region(&sc->ps_mem, 0, PXA2X0_CS_SIZE * 6) != 0)
112		panic("pxa_smi_attach: failed ot set up mem rman");
113
114	sc->ps_bst = base_tag;
115	sc->ps_base = rman_get_start(sc->ps_res[0]);
116
117	i = 0;
118	while (resource_find_match(&i, &dname, &dunit, "at",
119	    device_get_nameunit(dev)) == 0) {
120		pxa_smi_add_device(dev, dname, dunit);
121	}
122
123	bus_generic_probe(dev);
124	bus_generic_attach(dev);
125
126	return (0);
127}
128
129static int
130pxa_smi_print_child(device_t dev, device_t child)
131{
132	struct	smi_ivars *smid;
133	int	retval;
134
135	smid = (struct smi_ivars *)device_get_ivars(child);
136	if (smid == NULL) {
137		device_printf(dev, "unknown device: %s\n",
138		    device_get_nameunit(child));
139		return (0);
140	}
141
142	retval = 0;
143
144	retval += bus_print_child_header(dev, child);
145
146	retval += resource_list_print_type(&smid->smid_resources, "at mem",
147	    SYS_RES_MEMORY, "%#lx");
148	retval += resource_list_print_type(&smid->smid_resources, "irq",
149	    SYS_RES_IRQ, "%ld");
150
151	retval += bus_print_child_footer(dev, child);
152
153	return (retval);
154}
155
156static int
157pxa_smi_read_ivar(device_t dev, device_t child, int which, uintptr_t *result)
158{
159	struct	pxa_smi_softc *sc;
160	struct	smi_ivars *smid;
161
162	sc = device_get_softc(dev);
163	smid = device_get_ivars(child);
164
165	switch (which) {
166	case SMI_IVAR_PHYSBASE:
167		*((bus_addr_t *)result) = smid->smid_mem;
168		break;
169
170	default:
171		return (ENOENT);
172	}
173
174	return (0);
175}
176
177static struct resource *
178pxa_smi_alloc_resource(device_t dev, device_t child, int type, int *rid,
179    u_long start, u_long end, u_long count, u_int flags)
180{
181	struct	pxa_smi_softc *sc;
182	struct	smi_ivars *smid;
183	struct	resource *rv;
184	struct	resource_list *rl;
185	struct	resource_list_entry *rle;
186	int	needactivate;
187
188	sc = (struct pxa_smi_softc *)device_get_softc(dev);
189	smid = (struct smi_ivars *)device_get_ivars(child);
190	rl = &smid->smid_resources;
191
192	if (type == SYS_RES_IOPORT)
193		type = SYS_RES_MEMORY;
194
195	rle = resource_list_find(rl, type, *rid);
196	if (rle == NULL)
197		return (NULL);
198	if (rle->res != NULL)
199		panic("pxa_smi_alloc_resource: resource is busy");
200
201	needactivate = flags & RF_ACTIVE;
202	flags &= ~RF_ACTIVE;
203
204	switch (type) {
205	case SYS_RES_MEMORY:
206		rv = rman_reserve_resource(&sc->ps_mem, rle->start, rle->end,
207		    rle->count, flags, child);
208		if (rv == NULL)
209			return (NULL);
210		rle->res = rv;
211		rman_set_rid(rv, *rid);
212		rman_set_bustag(rv, sc->ps_bst);
213		rman_set_bushandle(rv, rle->start);
214		if (needactivate) {
215			if (bus_activate_resource(child, type, *rid, rv) != 0) {
216				rman_release_resource(rv);
217				return (NULL);
218			}
219		}
220
221		break;
222
223	case SYS_RES_IRQ:
224		rv = bus_alloc_resource(dev, type, rid, rle->start, rle->end,
225		    rle->count, flags);
226		if (rv == NULL)
227			return (NULL);
228		if (needactivate) {
229			if (bus_activate_resource(child, type, *rid, rv) != 0) {
230				bus_release_resource(dev, type, *rid, rv);
231				return (NULL);
232			}
233		}
234
235		break;
236
237	default:
238		return (NULL);
239	}
240
241	return (rv);
242}
243
244static int
245pxa_smi_release_resource(device_t dev, device_t child, int type, int rid,
246    struct resource *r)
247{
248	struct	smi_ivars *smid;
249	struct	resource_list *rl;
250	struct	resource_list_entry *rle;
251
252	if (type == SYS_RES_IRQ)
253		return (bus_release_resource(dev, SYS_RES_IRQ, rid, r));
254
255	smid = (struct smi_ivars *)device_get_ivars(child);
256	rl = &smid->smid_resources;
257
258	if (type == SYS_RES_IOPORT)
259		type = SYS_RES_MEMORY;
260
261	rle = resource_list_find(rl, type, rid);
262	if (rle == NULL)
263		panic("pxa_smi_release_resource: can't find resource");
264	if (rle->res == NULL)
265		panic("pxa_smi_release_resource: resource entry not busy");
266
267	rman_release_resource(rle->res);
268	rle->res = NULL;
269
270	return (0);
271}
272
273static int
274pxa_smi_activate_resource(device_t dev, device_t child, int type, int rid,
275    struct resource *r)
276{
277	struct	pxa_smi_softc *sc;
278
279	sc = (struct pxa_smi_softc *)device_get_softc(dev);
280
281	if (type == SYS_RES_IRQ)
282		return (bus_activate_resource(dev, SYS_RES_IRQ, rid, r));
283
284	rman_set_bushandle(r, (bus_space_handle_t)pmap_mapdev(rman_get_start(r),
285	    rman_get_size(r)));
286	return (rman_activate_resource(r));
287}
288
289static device_method_t pxa_smi_methods[] = {
290	DEVMETHOD(device_probe, pxa_smi_probe),
291	DEVMETHOD(device_attach, pxa_smi_attach),
292
293	DEVMETHOD(bus_print_child, pxa_smi_print_child),
294
295	DEVMETHOD(bus_read_ivar, pxa_smi_read_ivar),
296
297	DEVMETHOD(bus_setup_intr, bus_generic_setup_intr),
298
299	DEVMETHOD(bus_alloc_resource, pxa_smi_alloc_resource),
300	DEVMETHOD(bus_release_resource, pxa_smi_release_resource),
301	DEVMETHOD(bus_activate_resource, pxa_smi_activate_resource),
302
303	{0, 0}
304};
305
306static driver_t pxa_smi_driver = {
307	"smi",
308	pxa_smi_methods,
309	sizeof(struct pxa_smi_softc),
310};
311
312static devclass_t pxa_smi_devclass;
313
314DRIVER_MODULE(smi, pxa, pxa_smi_driver, pxa_smi_devclass, 0, 0);
315
316static void
317pxa_smi_add_device(device_t dev, const char *name, int unit)
318{
319	device_t	child;
320	int		start, count;
321	struct		smi_ivars *ivars;
322
323	ivars = (struct smi_ivars *)malloc(
324	    sizeof(struct smi_ivars), M_PXASMI, M_WAITOK);
325	if (ivars == NULL)
326		return;
327
328	child = device_add_child(dev, name, unit);
329	if (child == NULL) {
330		free(ivars, M_PXASMI);
331		return;
332	}
333
334	device_set_ivars(child, ivars);
335	resource_list_init(&ivars->smid_resources);
336
337	start = 0;
338	count = 0;
339	resource_int_value(name, unit, "mem", &start);
340	resource_int_value(name, unit, "size", &count);
341	if (start > 0 || count > 0) {
342		resource_list_add(&ivars->smid_resources, SYS_RES_MEMORY, 0,
343		    start, start + count, count);
344		ivars->smid_mem = (bus_addr_t)start;
345	}
346
347	start = -1;
348	count = 0;
349	resource_int_value(name, unit, "irq", &start);
350	if (start > -1)
351		resource_list_add(&ivars->smid_resources, SYS_RES_IRQ, 0, start,
352		     start, 1);
353
354	if (resource_disabled(name, unit))
355		device_disable(child);
356}
357