central.c revision 1.2 
1/*	$NetBSD: central.c,v 1.2 2011/08/01 08:36:39 mrg Exp $	*/
2/*	$OpenBSD: central.c,v 1.7 2010/11/11 17:58:23 miod Exp $	*/
3
4/*
5 * Copyright (c) 2004 Jason L. Wright (jason@thought.net)
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 *    notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 *    notice, this list of conditions and the following disclaimer in the
15 *    documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
19 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
20 * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
21 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
22 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
23 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
25 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
26 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
27 * POSSIBILITY OF SUCH DAMAGE.
28 */
29
30#include <sys/types.h>
31#include <sys/param.h>
32#include <sys/systm.h>
33#include <sys/kernel.h>
34#include <sys/device.h>
35#include <sys/conf.h>
36#include <sys/malloc.h>
37#include <sys/bus.h>
38
39#include <machine/autoconf.h>
40#include <machine/openfirm.h>
41
42#include <sparc64/dev/centralvar.h>
43
44struct central_softc {
45	bus_space_tag_t sc_bt;
46	bus_space_tag_t sc_cbt;
47	int sc_node;
48	int sc_nrange;
49	struct central_range *sc_range;
50};
51
52static int central_match(device_t, cfdata_t, void *);
53static void central_attach(device_t, device_t, void *);
54
55CFATTACH_DECL_NEW(central, sizeof(struct central_softc),
56    central_match, central_attach, NULL, NULL);
57
58static int central_print(void *, const char *);
59static int central_get_string(int, const char *, char **);
60
61static bus_space_tag_t central_alloc_bus_tag(struct central_softc *);
62static int _central_bus_map(
63		bus_space_tag_t,
64		bus_addr_t,		/*offset*/
65		bus_size_t,		/*size*/
66		int,			/*flags*/
67		vaddr_t,		/* XXX unused -- compat w/sparc */
68		bus_space_handle_t *);
69
70static int
71central_match(device_t parent, cfdata_t match, void *aux)
72{
73	struct mainbus_attach_args *ma = aux;
74
75	if (strcmp(ma->ma_name, "central") == 0)
76		return (1);
77	return (0);
78}
79
80static void
81central_attach(device_t parent, device_t self, void *aux)
82{
83	struct central_softc *sc = device_private(self);
84	struct mainbus_attach_args *ma = aux;
85	int node0, node;
86
87	sc->sc_bt = ma->ma_bustag;
88	sc->sc_node = ma->ma_node;
89	sc->sc_cbt = central_alloc_bus_tag(sc);
90
91	prom_getprop(sc->sc_node, "ranges", sizeof(struct central_range),
92	    &sc->sc_nrange, (void **)&sc->sc_range);
93
94	printf("\n");
95
96	node0 = firstchild(sc->sc_node);
97	for (node = node0; node; node = nextsibling(node)) {
98		struct central_attach_args ca;
99
100		bzero(&ca, sizeof(ca));
101		ca.ca_node = node;
102		ca.ca_bustag = sc->sc_cbt;
103		if (central_get_string(ca.ca_node, "name", &ca.ca_name)) {
104			printf("can't fetch name for node 0x%x\n", node);
105			continue;
106		}
107
108		prom_getprop(node, "reg", sizeof(struct central_reg),
109		    &ca.ca_nreg, (void **)&ca.ca_reg);
110
111		(void)config_found(self, (void *)&ca, central_print);
112
113		if (ca.ca_name != NULL)
114			free(ca.ca_name, M_DEVBUF);
115	}
116}
117
118static int
119central_get_string(int node, const char *name, char **buf)
120{
121	int len;
122
123	len = prom_getproplen(node, name);
124	if (len < 0)
125		return (len);
126	*buf = (char *)malloc(len + 1, M_DEVBUF, M_NOWAIT);
127	if (*buf == NULL)
128		return (-1);
129
130	if (len != 0)
131		prom_getpropstringA(node, name, *buf, len + 1);
132	(*buf)[len] = '\0';
133	return (0);
134}
135
136static int
137central_print(void *args, const char *busname)
138{
139	struct central_attach_args *ca = args;
140	char *class;
141
142	if (busname != NULL) {
143		printf("\"%s\" at %s", ca->ca_name, busname);
144		class = prom_getpropstring(ca->ca_node, "device_type");
145		if (*class != '\0')
146			printf(" class %s", class);
147	}
148	return (UNCONF);
149}
150
151static bus_space_tag_t
152central_alloc_bus_tag(struct central_softc *sc)
153{
154	struct sparc_bus_space_tag *bt;
155
156	bt = malloc(sizeof(*bt), M_DEVBUF, M_NOWAIT | M_ZERO);
157	if (bt == NULL)
158		panic("central: couldn't alloc bus tag");
159
160	bt->cookie = sc;
161	bt->parent = sc->sc_bt;
162#if 0
163	bt->asi = bt->parent->asi;
164	bt->sasi = bt->parent->sasi;
165#endif
166	bt->sparc_bus_map = _central_bus_map;
167	/* XXX bt->sparc_bus_mmap = central_bus_mmap; */
168	/* XXX bt->sparc_intr_establish = upa_intr_establish; */
169	return (bt);
170}
171
172static int
173_central_bus_map(bus_space_tag_t t, bus_addr_t addr, bus_size_t size, int flags,
174	vaddr_t v, bus_space_handle_t *hp)
175{
176	struct central_softc *sc = t->cookie;
177	int64_t slot = BUS_ADDR_IOSPACE(addr);
178	int64_t offset = BUS_ADDR_PADDR(addr);
179	int i;
180
181	if (t->parent == NULL || t->parent->sparc_bus_map == NULL) {
182		printf("\ncentral_bus_map: invalid parent");
183		return (EINVAL);
184	}
185
186
187	for (i = 0; i < sc->sc_nrange; i++) {
188		bus_addr_t paddr;
189
190		if (sc->sc_range[i].cspace != slot)
191			continue;
192
193		paddr = offset - sc->sc_range[i].coffset;
194		paddr += sc->sc_range[i].poffset;
195		paddr |= ((bus_addr_t)sc->sc_range[i].pspace << 32);
196
197		return bus_space_map(t->parent, paddr, size, flags, hp);
198	}
199
200	return (EINVAL);
201}
202