1/*-
2 * Copyright (c) 2001 - 2003 by Thomas Moestl <tmm@FreeBSD.org>.
3 * Copyright (c) 2005 Marius Strobl <marius@FreeBSD.org>
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, this list of conditions, and the following disclaimer,
11 * without modification, immediately at the beginning of the file.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in
14 * the documentation and/or other materials provided with the
15 * distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
21 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 */
29
30#include <sys/cdefs.h>
| 1/*-
2 * Copyright (c) 2001 - 2003 by Thomas Moestl <tmm@FreeBSD.org>.
3 * Copyright (c) 2005 Marius Strobl <marius@FreeBSD.org>
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, this list of conditions, and the following disclaimer,
11 * without modification, immediately at the beginning of the file.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in
14 * the documentation and/or other materials provided with the
15 * distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
21 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 */
29
30#include <sys/cdefs.h>
|
32
33#include "opt_platform.h"
34#include <sys/param.h>
35#include <sys/systm.h>
36#include <sys/bus.h>
37#include <sys/errno.h>
38#include <sys/libkern.h>
39
40#include <dev/ofw/ofw_bus.h>
41#include <dev/ofw/ofw_bus_subr.h>
42#include <dev/ofw/openfirm.h>
43
44#include "ofw_bus_if.h"
45
46int
47ofw_bus_gen_setup_devinfo(struct ofw_bus_devinfo *obd, phandle_t node)
48{
49
50 if (obd == NULL)
51 return (ENOMEM);
52 /* The 'name' property is considered mandatory. */
53 if ((OF_getprop_alloc(node, "name", 1, (void **)&obd->obd_name)) == -1)
54 return (EINVAL);
55 OF_getprop_alloc(node, "compatible", 1, (void **)&obd->obd_compat);
56 OF_getprop_alloc(node, "device_type", 1, (void **)&obd->obd_type);
57 OF_getprop_alloc(node, "model", 1, (void **)&obd->obd_model);
58 obd->obd_node = node;
59 return (0);
60}
61
62void
63ofw_bus_gen_destroy_devinfo(struct ofw_bus_devinfo *obd)
64{
65
66 if (obd == NULL)
67 return;
68 if (obd->obd_compat != NULL)
69 free(obd->obd_compat, M_OFWPROP);
70 if (obd->obd_model != NULL)
71 free(obd->obd_model, M_OFWPROP);
72 if (obd->obd_name != NULL)
73 free(obd->obd_name, M_OFWPROP);
74 if (obd->obd_type != NULL)
75 free(obd->obd_type, M_OFWPROP);
76}
77
78int
79ofw_bus_gen_child_pnpinfo_str(device_t cbdev, device_t child, char *buf,
80 size_t buflen)
81{
82
83 if (ofw_bus_get_name(child) != NULL) {
84 strlcat(buf, "name=", buflen);
85 strlcat(buf, ofw_bus_get_name(child), buflen);
86 }
87
88 if (ofw_bus_get_compat(child) != NULL) {
89 strlcat(buf, " compat=", buflen);
90 strlcat(buf, ofw_bus_get_compat(child), buflen);
91 }
92 return (0);
93};
94
95const char *
96ofw_bus_gen_get_compat(device_t bus, device_t dev)
97{
98 const struct ofw_bus_devinfo *obd;
99
100 obd = OFW_BUS_GET_DEVINFO(bus, dev);
101 if (obd == NULL)
102 return (NULL);
103 return (obd->obd_compat);
104}
105
106const char *
107ofw_bus_gen_get_model(device_t bus, device_t dev)
108{
109 const struct ofw_bus_devinfo *obd;
110
111 obd = OFW_BUS_GET_DEVINFO(bus, dev);
112 if (obd == NULL)
113 return (NULL);
114 return (obd->obd_model);
115}
116
117const char *
118ofw_bus_gen_get_name(device_t bus, device_t dev)
119{
120 const struct ofw_bus_devinfo *obd;
121
122 obd = OFW_BUS_GET_DEVINFO(bus, dev);
123 if (obd == NULL)
124 return (NULL);
125 return (obd->obd_name);
126}
127
128phandle_t
129ofw_bus_gen_get_node(device_t bus, device_t dev)
130{
131 const struct ofw_bus_devinfo *obd;
132
133 obd = OFW_BUS_GET_DEVINFO(bus, dev);
134 if (obd == NULL)
135 return (0);
136 return (obd->obd_node);
137}
138
139const char *
140ofw_bus_gen_get_type(device_t bus, device_t dev)
141{
142 const struct ofw_bus_devinfo *obd;
143
144 obd = OFW_BUS_GET_DEVINFO(bus, dev);
145 if (obd == NULL)
146 return (NULL);
147 return (obd->obd_type);
148}
149
150int
151ofw_bus_is_compatible(device_t dev, const char *onecompat)
152{
153 phandle_t node;
154 const char *compat;
155 int len, onelen, l;
156
157 if ((compat = ofw_bus_get_compat(dev)) == NULL)
158 return (0);
159
| 32
33#include "opt_platform.h"
34#include <sys/param.h>
35#include <sys/systm.h>
36#include <sys/bus.h>
37#include <sys/errno.h>
38#include <sys/libkern.h>
39
40#include <dev/ofw/ofw_bus.h>
41#include <dev/ofw/ofw_bus_subr.h>
42#include <dev/ofw/openfirm.h>
43
44#include "ofw_bus_if.h"
45
46int
47ofw_bus_gen_setup_devinfo(struct ofw_bus_devinfo *obd, phandle_t node)
48{
49
50 if (obd == NULL)
51 return (ENOMEM);
52 /* The 'name' property is considered mandatory. */
53 if ((OF_getprop_alloc(node, "name", 1, (void **)&obd->obd_name)) == -1)
54 return (EINVAL);
55 OF_getprop_alloc(node, "compatible", 1, (void **)&obd->obd_compat);
56 OF_getprop_alloc(node, "device_type", 1, (void **)&obd->obd_type);
57 OF_getprop_alloc(node, "model", 1, (void **)&obd->obd_model);
58 obd->obd_node = node;
59 return (0);
60}
61
62void
63ofw_bus_gen_destroy_devinfo(struct ofw_bus_devinfo *obd)
64{
65
66 if (obd == NULL)
67 return;
68 if (obd->obd_compat != NULL)
69 free(obd->obd_compat, M_OFWPROP);
70 if (obd->obd_model != NULL)
71 free(obd->obd_model, M_OFWPROP);
72 if (obd->obd_name != NULL)
73 free(obd->obd_name, M_OFWPROP);
74 if (obd->obd_type != NULL)
75 free(obd->obd_type, M_OFWPROP);
76}
77
78int
79ofw_bus_gen_child_pnpinfo_str(device_t cbdev, device_t child, char *buf,
80 size_t buflen)
81{
82
83 if (ofw_bus_get_name(child) != NULL) {
84 strlcat(buf, "name=", buflen);
85 strlcat(buf, ofw_bus_get_name(child), buflen);
86 }
87
88 if (ofw_bus_get_compat(child) != NULL) {
89 strlcat(buf, " compat=", buflen);
90 strlcat(buf, ofw_bus_get_compat(child), buflen);
91 }
92 return (0);
93};
94
95const char *
96ofw_bus_gen_get_compat(device_t bus, device_t dev)
97{
98 const struct ofw_bus_devinfo *obd;
99
100 obd = OFW_BUS_GET_DEVINFO(bus, dev);
101 if (obd == NULL)
102 return (NULL);
103 return (obd->obd_compat);
104}
105
106const char *
107ofw_bus_gen_get_model(device_t bus, device_t dev)
108{
109 const struct ofw_bus_devinfo *obd;
110
111 obd = OFW_BUS_GET_DEVINFO(bus, dev);
112 if (obd == NULL)
113 return (NULL);
114 return (obd->obd_model);
115}
116
117const char *
118ofw_bus_gen_get_name(device_t bus, device_t dev)
119{
120 const struct ofw_bus_devinfo *obd;
121
122 obd = OFW_BUS_GET_DEVINFO(bus, dev);
123 if (obd == NULL)
124 return (NULL);
125 return (obd->obd_name);
126}
127
128phandle_t
129ofw_bus_gen_get_node(device_t bus, device_t dev)
130{
131 const struct ofw_bus_devinfo *obd;
132
133 obd = OFW_BUS_GET_DEVINFO(bus, dev);
134 if (obd == NULL)
135 return (0);
136 return (obd->obd_node);
137}
138
139const char *
140ofw_bus_gen_get_type(device_t bus, device_t dev)
141{
142 const struct ofw_bus_devinfo *obd;
143
144 obd = OFW_BUS_GET_DEVINFO(bus, dev);
145 if (obd == NULL)
146 return (NULL);
147 return (obd->obd_type);
148}
149
150int
151ofw_bus_is_compatible(device_t dev, const char *onecompat)
152{
153 phandle_t node;
154 const char *compat;
155 int len, onelen, l;
156
157 if ((compat = ofw_bus_get_compat(dev)) == NULL)
158 return (0);
159
|
161 return (0);
162
163 /* Get total 'compatible' prop len */
164 if ((len = OF_getproplen(node, "compatible")) <= 0)
165 return (0);
166
167 onelen = strlen(onecompat);
168
169 while (len > 0) {
170 if (strncasecmp(compat, onecompat, onelen) == 0)
171 /* Found it. */
172 return (1);
173
174 /* Slide to the next sub-string. */
175 l = strlen(compat) + 1;
176 compat += l;
177 len -= l;
178 }
179 return (0);
180}
181
182int
183ofw_bus_is_compatible_strict(device_t dev, const char *compatible)
184{
185 const char *compat;
186
187 if ((compat = ofw_bus_get_compat(dev)) == NULL)
188 return (0);
189
190 if (strncasecmp(compat, compatible, strlen(compatible)) == 0)
191 return (1);
192
193 return (0);
194}
195
196#ifndef FDT
197void
198ofw_bus_setup_iinfo(phandle_t node, struct ofw_bus_iinfo *ii, int intrsz)
199{
200 pcell_t addrc;
201 int msksz;
202
203 if (OF_getprop(node, "#address-cells", &addrc, sizeof(addrc)) == -1)
204 addrc = 2;
205 ii->opi_addrc = addrc * sizeof(pcell_t);
206
207 ii->opi_imapsz = OF_getprop_alloc(node, "interrupt-map", 1,
208 (void **)&ii->opi_imap);
209 if (ii->opi_imapsz > 0) {
210 msksz = OF_getprop_alloc(node, "interrupt-map-mask", 1,
211 (void **)&ii->opi_imapmsk);
212 /*
213 * Failure to get the mask is ignored; a full mask is used
214 * then. We barf on bad mask sizes, however.
215 */
216 if (msksz != -1 && msksz != ii->opi_addrc + intrsz)
217 panic("ofw_bus_setup_iinfo: bad interrupt-map-mask "
218 "property!");
219 }
220}
221
222int
223ofw_bus_lookup_imap(phandle_t node, struct ofw_bus_iinfo *ii, void *reg,
224 int regsz, void *pintr, int pintrsz, void *mintr, int mintrsz,
225 phandle_t *iparent, void *maskbuf)
226{
227 int rv;
228
229 if (ii->opi_imapsz <= 0)
230 return (0);
231 KASSERT(regsz >= ii->opi_addrc,
232 ("ofw_bus_lookup_imap: register size too small: %d < %d",
233 regsz, ii->opi_addrc));
234 rv = OF_getprop(node, "reg", reg, regsz);
235 if (rv < regsz)
236 panic("ofw_bus_lookup_imap: could not get reg property");
237 return (ofw_bus_search_intrmap(pintr, pintrsz, reg, ii->opi_addrc,
238 ii->opi_imap, ii->opi_imapsz, ii->opi_imapmsk, maskbuf, mintr,
239 mintrsz, iparent));
240}
241
242/*
243 * Map an interrupt using the firmware reg, interrupt-map and
244 * interrupt-map-mask properties.
245 * The interrupt property to be mapped must be of size intrsz, and pointed to
246 * by intr. The regs property of the node for which the mapping is done must
247 * be passed as regs. This property is an array of register specifications;
248 * the size of the address part of such a specification must be passed as
249 * physsz. Only the first element of the property is used.
250 * imap and imapsz hold the interrupt mask and it's size.
251 * imapmsk is a pointer to the interrupt-map-mask property, which must have
252 * a size of physsz + intrsz; it may be NULL, in which case a full mask is
253 * assumed.
254 * maskbuf must point to a buffer of length physsz + intrsz.
255 * The interrupt is returned in result, which must point to a buffer of length
256 * rintrsz (which gives the expected size of the mapped interrupt).
257 * Returns 1 if a mapping was found, 0 otherwise.
258 */
259int
260ofw_bus_search_intrmap(void *intr, int intrsz, void *regs, int physsz,
261 void *imap, int imapsz, void *imapmsk, void *maskbuf, void *result,
262 int rintrsz, phandle_t *iparent)
263{
264 phandle_t parent;
265 uint8_t *ref = maskbuf;
266 uint8_t *uiintr = intr;
267 uint8_t *uiregs = regs;
268 uint8_t *uiimapmsk = imapmsk;
269 uint8_t *mptr;
270 pcell_t pintrsz;
271 int i, rsz, tsz;
272
273 rsz = -1;
274 if (imapmsk != NULL) {
275 for (i = 0; i < physsz; i++)
276 ref[i] = uiregs[i] & uiimapmsk[i];
277 for (i = 0; i < intrsz; i++)
278 ref[physsz + i] = uiintr[i] & uiimapmsk[physsz + i];
279 } else {
280 bcopy(regs, ref, physsz);
281 bcopy(intr, ref + physsz, intrsz);
282 }
283
284 mptr = imap;
285 i = imapsz;
286 while (i > 0) {
287 bcopy(mptr + physsz + intrsz, &parent, sizeof(parent));
288 if (OF_searchprop(parent, "#interrupt-cells",
289 &pintrsz, sizeof(pintrsz)) == -1)
290 pintrsz = 1; /* default */
291 pintrsz *= sizeof(pcell_t);
292
293 /* Compute the map stride size. */
294 tsz = physsz + intrsz + sizeof(phandle_t) + pintrsz;
295 KASSERT(i >= tsz, ("ofw_bus_search_intrmap: truncated map"));
296
297 /*
298 * XXX: Apple hardware uses a second cell to set information
299 * on the interrupt trigger type. This information should
300 * be used somewhere to program the PIC.
301 */
302
303 if (bcmp(ref, mptr, physsz + intrsz) == 0) {
304 bcopy(mptr + physsz + intrsz + sizeof(parent),
305 result, rintrsz);
306
307 if (iparent != NULL)
308 *iparent = parent;
309 return (1);
310 }
311 mptr += tsz;
312 i -= tsz;
313 }
314 return (0);
315}
316#endif /* !FDT */
| 161 return (0);
162
163 /* Get total 'compatible' prop len */
164 if ((len = OF_getproplen(node, "compatible")) <= 0)
165 return (0);
166
167 onelen = strlen(onecompat);
168
169 while (len > 0) {
170 if (strncasecmp(compat, onecompat, onelen) == 0)
171 /* Found it. */
172 return (1);
173
174 /* Slide to the next sub-string. */
175 l = strlen(compat) + 1;
176 compat += l;
177 len -= l;
178 }
179 return (0);
180}
181
182int
183ofw_bus_is_compatible_strict(device_t dev, const char *compatible)
184{
185 const char *compat;
186
187 if ((compat = ofw_bus_get_compat(dev)) == NULL)
188 return (0);
189
190 if (strncasecmp(compat, compatible, strlen(compatible)) == 0)
191 return (1);
192
193 return (0);
194}
195
196#ifndef FDT
197void
198ofw_bus_setup_iinfo(phandle_t node, struct ofw_bus_iinfo *ii, int intrsz)
199{
200 pcell_t addrc;
201 int msksz;
202
203 if (OF_getprop(node, "#address-cells", &addrc, sizeof(addrc)) == -1)
204 addrc = 2;
205 ii->opi_addrc = addrc * sizeof(pcell_t);
206
207 ii->opi_imapsz = OF_getprop_alloc(node, "interrupt-map", 1,
208 (void **)&ii->opi_imap);
209 if (ii->opi_imapsz > 0) {
210 msksz = OF_getprop_alloc(node, "interrupt-map-mask", 1,
211 (void **)&ii->opi_imapmsk);
212 /*
213 * Failure to get the mask is ignored; a full mask is used
214 * then. We barf on bad mask sizes, however.
215 */
216 if (msksz != -1 && msksz != ii->opi_addrc + intrsz)
217 panic("ofw_bus_setup_iinfo: bad interrupt-map-mask "
218 "property!");
219 }
220}
221
222int
223ofw_bus_lookup_imap(phandle_t node, struct ofw_bus_iinfo *ii, void *reg,
224 int regsz, void *pintr, int pintrsz, void *mintr, int mintrsz,
225 phandle_t *iparent, void *maskbuf)
226{
227 int rv;
228
229 if (ii->opi_imapsz <= 0)
230 return (0);
231 KASSERT(regsz >= ii->opi_addrc,
232 ("ofw_bus_lookup_imap: register size too small: %d < %d",
233 regsz, ii->opi_addrc));
234 rv = OF_getprop(node, "reg", reg, regsz);
235 if (rv < regsz)
236 panic("ofw_bus_lookup_imap: could not get reg property");
237 return (ofw_bus_search_intrmap(pintr, pintrsz, reg, ii->opi_addrc,
238 ii->opi_imap, ii->opi_imapsz, ii->opi_imapmsk, maskbuf, mintr,
239 mintrsz, iparent));
240}
241
242/*
243 * Map an interrupt using the firmware reg, interrupt-map and
244 * interrupt-map-mask properties.
245 * The interrupt property to be mapped must be of size intrsz, and pointed to
246 * by intr. The regs property of the node for which the mapping is done must
247 * be passed as regs. This property is an array of register specifications;
248 * the size of the address part of such a specification must be passed as
249 * physsz. Only the first element of the property is used.
250 * imap and imapsz hold the interrupt mask and it's size.
251 * imapmsk is a pointer to the interrupt-map-mask property, which must have
252 * a size of physsz + intrsz; it may be NULL, in which case a full mask is
253 * assumed.
254 * maskbuf must point to a buffer of length physsz + intrsz.
255 * The interrupt is returned in result, which must point to a buffer of length
256 * rintrsz (which gives the expected size of the mapped interrupt).
257 * Returns 1 if a mapping was found, 0 otherwise.
258 */
259int
260ofw_bus_search_intrmap(void *intr, int intrsz, void *regs, int physsz,
261 void *imap, int imapsz, void *imapmsk, void *maskbuf, void *result,
262 int rintrsz, phandle_t *iparent)
263{
264 phandle_t parent;
265 uint8_t *ref = maskbuf;
266 uint8_t *uiintr = intr;
267 uint8_t *uiregs = regs;
268 uint8_t *uiimapmsk = imapmsk;
269 uint8_t *mptr;
270 pcell_t pintrsz;
271 int i, rsz, tsz;
272
273 rsz = -1;
274 if (imapmsk != NULL) {
275 for (i = 0; i < physsz; i++)
276 ref[i] = uiregs[i] & uiimapmsk[i];
277 for (i = 0; i < intrsz; i++)
278 ref[physsz + i] = uiintr[i] & uiimapmsk[physsz + i];
279 } else {
280 bcopy(regs, ref, physsz);
281 bcopy(intr, ref + physsz, intrsz);
282 }
283
284 mptr = imap;
285 i = imapsz;
286 while (i > 0) {
287 bcopy(mptr + physsz + intrsz, &parent, sizeof(parent));
288 if (OF_searchprop(parent, "#interrupt-cells",
289 &pintrsz, sizeof(pintrsz)) == -1)
290 pintrsz = 1; /* default */
291 pintrsz *= sizeof(pcell_t);
292
293 /* Compute the map stride size. */
294 tsz = physsz + intrsz + sizeof(phandle_t) + pintrsz;
295 KASSERT(i >= tsz, ("ofw_bus_search_intrmap: truncated map"));
296
297 /*
298 * XXX: Apple hardware uses a second cell to set information
299 * on the interrupt trigger type. This information should
300 * be used somewhere to program the PIC.
301 */
302
303 if (bcmp(ref, mptr, physsz + intrsz) == 0) {
304 bcopy(mptr + physsz + intrsz + sizeof(parent),
305 result, rintrsz);
306
307 if (iparent != NULL)
308 *iparent = parent;
309 return (1);
310 }
311 mptr += tsz;
312 i -= tsz;
313 }
314 return (0);
315}
316#endif /* !FDT */
|