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 (at) 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
44 struct 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
52 static int central_match(device_t, cfdata_t, void *);
53 static void central_attach(device_t, device_t, void *);
54
55 CFATTACH_DECL_NEW(central, sizeof(struct central_softc),
56 central_match, central_attach, NULL, NULL);
57
58 static int central_print(void *, const char *);
59 static int central_get_string(int, const char *, char **);
60
61 static bus_space_tag_t central_alloc_bus_tag(struct central_softc *);
62 static 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
70 static int
71 central_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
80 static void
81 central_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
118 static int
119 central_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
136 static int
137 central_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
151 static bus_space_tag_t
152 central_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
172 static 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