xref: /titanic_50/usr/src/uts/sun4/os/ddi_impl.c (revision 42cac157f878fbb7ae190eb0339c6932f3192b87)
1 /*
2  * CDDL HEADER START
3  *
4  * The contents of this file are subject to the terms of the
5  * Common Development and Distribution License (the "License").
6  * You may not use this file except in compliance with the License.
7  *
8  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9  * or http://www.opensolaris.org/os/licensing.
10  * See the License for the specific language governing permissions
11  * and limitations under the License.
12  *
13  * When distributing Covered Code, include this CDDL HEADER in each
14  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15  * If applicable, add the following below this CDDL HEADER, with the
16  * fields enclosed by brackets "[]" replaced with your own identifying
17  * information: Portions Copyright [yyyy] [name of copyright owner]
18  *
19  * CDDL HEADER END
20  */
21 
22 /*
23  * Copyright 2009 Sun Microsystems, Inc.  All rights reserved.
24  * Use is subject to license terms.
25  */
26 
27 /*
28  * sun4 specific DDI implementation
29  */
30 #include <sys/cpuvar.h>
31 #include <sys/ddi_subrdefs.h>
32 #include <sys/machsystm.h>
33 #include <sys/sunndi.h>
34 #include <sys/sysmacros.h>
35 #include <sys/ontrap.h>
36 #include <vm/seg_kmem.h>
37 #include <sys/membar.h>
38 #include <sys/dditypes.h>
39 #include <sys/ndifm.h>
40 #include <sys/fm/io/ddi.h>
41 #include <sys/ivintr.h>
42 #include <sys/bootconf.h>
43 #include <sys/conf.h>
44 #include <sys/ethernet.h>
45 #include <sys/idprom.h>
46 #include <sys/promif.h>
47 #include <sys/prom_plat.h>
48 #include <sys/systeminfo.h>
49 #include <sys/fpu/fpusystm.h>
50 #include <sys/vm.h>
51 #include <sys/fs/dv_node.h>
52 #include <sys/fs/snode.h>
53 #include <sys/ddi_isa.h>
54 #include <sys/modhash.h>
55 #include <sys/modctl.h>
56 #include <sys/sunldi_impl.h>
57 
58 dev_info_t *get_intr_parent(dev_info_t *, dev_info_t *,
59     ddi_intr_handle_impl_t *);
60 #pragma weak get_intr_parent
61 
62 int process_intr_ops(dev_info_t *, dev_info_t *, ddi_intr_op_t,
63     ddi_intr_handle_impl_t *, void *);
64 #pragma weak process_intr_ops
65 
66 void cells_1275_copy(prop_1275_cell_t *, prop_1275_cell_t *, int32_t);
67     prop_1275_cell_t *cells_1275_cmp(prop_1275_cell_t *, prop_1275_cell_t *,
68     int32_t len);
69 #pragma weak cells_1275_copy
70 
71 /*
72  * Wrapper for ddi_prop_lookup_int_array().
73  * This is handy because it returns the prop length in
74  * bytes which is what most of the callers require.
75  */
76 
77 static int
78 get_prop_int_array(dev_info_t *di, char *pname, int **pval, uint_t *plen)
79 {
80 	int ret;
81 
82 	if ((ret = ddi_prop_lookup_int_array(DDI_DEV_T_ANY, di,
83 	    DDI_PROP_DONTPASS, pname, pval, plen)) == DDI_PROP_SUCCESS) {
84 		*plen = (*plen) * (uint_t)sizeof (int);
85 	}
86 	return (ret);
87 }
88 
89 /*
90  * SECTION: DDI Node Configuration
91  */
92 
93 /*
94  * init_regspec_64:
95  *
96  * If the parent #size-cells is 2, convert the upa-style or
97  * safari-style reg property from 2-size cells to 1 size cell
98  * format, ignoring the size_hi, which must be zero for devices.
99  * (It won't be zero in the memory list properties in the memory
100  * nodes, but that doesn't matter here.)
101  */
102 struct ddi_parent_private_data *
103 init_regspec_64(dev_info_t *dip)
104 {
105 	struct ddi_parent_private_data *pd;
106 	dev_info_t *parent;
107 	int size_cells;
108 
109 	/*
110 	 * If there are no "reg"s in the child node, return.
111 	 */
112 	pd = ddi_get_parent_data(dip);
113 	if ((pd == NULL) || (pd->par_nreg == 0)) {
114 		return (pd);
115 	}
116 	parent = ddi_get_parent(dip);
117 
118 	size_cells = ddi_prop_get_int(DDI_DEV_T_ANY, parent,
119 	    DDI_PROP_DONTPASS, "#size-cells", 1);
120 
121 	if (size_cells != 1)  {
122 
123 		int n, j;
124 		struct regspec *irp;
125 		struct reg_64 {
126 			uint_t addr_hi, addr_lo, size_hi, size_lo;
127 		};
128 		struct reg_64 *r64_rp;
129 		struct regspec *rp;
130 		uint_t len = 0;
131 		int *reg_prop;
132 
133 		ASSERT(size_cells == 2);
134 
135 		/*
136 		 * We already looked the property up once before if
137 		 * pd is non-NULL.
138 		 */
139 		(void) ddi_prop_lookup_int_array(DDI_DEV_T_ANY, dip,
140 		    DDI_PROP_DONTPASS, OBP_REG, &reg_prop, &len);
141 		ASSERT(len != 0);
142 
143 		n = sizeof (struct reg_64) / sizeof (int);
144 		n = len / n;
145 
146 		/*
147 		 * We're allocating a buffer the size of the PROM's property,
148 		 * but we're only using a smaller portion when we assign it
149 		 * to a regspec.  We do this so that in the
150 		 * impl_ddi_sunbus_removechild function, we will
151 		 * always free the right amount of memory.
152 		 */
153 		irp = rp = (struct regspec *)reg_prop;
154 		r64_rp = (struct reg_64 *)pd->par_reg;
155 
156 		for (j = 0; j < n; ++j, ++rp, ++r64_rp) {
157 			ASSERT(r64_rp->size_hi == 0);
158 			rp->regspec_bustype = r64_rp->addr_hi;
159 			rp->regspec_addr = r64_rp->addr_lo;
160 			rp->regspec_size = r64_rp->size_lo;
161 		}
162 
163 		ddi_prop_free((void *)pd->par_reg);
164 		pd->par_nreg = n;
165 		pd->par_reg = irp;
166 	}
167 	return (pd);
168 }
169 
170 /*
171  * Create a ddi_parent_private_data structure from the ddi properties of
172  * the dev_info node.
173  *
174  * The "reg" is required if the driver wishes to create mappings on behalf
175  * of the device. The "reg" property is assumed to be a list of at least
176  * one triplet
177  *
178  *	<bustype, address, size>*1
179  *
180  * The "interrupt" property is no longer part of parent private data on
181  * sun4u. The interrupt parent is may not be the device tree parent.
182  *
183  * The "ranges" property describes the mapping of child addresses to parent
184  * addresses.
185  *
186  * N.B. struct rangespec is defined for the following default values:
187  *			parent  child
188  *	#address-cells	2	2
189  *	#size-cells	1	1
190  * This function doesn't deal with non-default cells and will not create
191  * ranges in such cases.
192  */
193 void
194 make_ddi_ppd(dev_info_t *child, struct ddi_parent_private_data **ppd)
195 {
196 	struct ddi_parent_private_data *pdptr;
197 	int *reg_prop, *rng_prop;
198 	uint_t reg_len = 0, rng_len = 0;
199 	dev_info_t *parent;
200 	int parent_addr_cells, parent_size_cells;
201 	int child_addr_cells, child_size_cells;
202 
203 	*ppd = pdptr = kmem_zalloc(sizeof (*pdptr), KM_SLEEP);
204 
205 	/*
206 	 * root node has no parent private data, so *ppd should
207 	 * be initialized for naming to work properly.
208 	 */
209 	if ((parent = ddi_get_parent(child)) == NULL)
210 		return;
211 
212 	/*
213 	 * Set reg field of parent data from "reg" property
214 	 */
215 	if ((get_prop_int_array(child, OBP_REG, &reg_prop, &reg_len)
216 	    == DDI_PROP_SUCCESS) && (reg_len != 0)) {
217 		pdptr->par_nreg = (int)(reg_len / sizeof (struct regspec));
218 		pdptr->par_reg = (struct regspec *)reg_prop;
219 	}
220 
221 	/*
222 	 * "ranges" property ...
223 	 *
224 	 * This function does not handle cases where #address-cells != 2
225 	 * and * min(parent, child) #size-cells != 1 (see bugid 4211124).
226 	 *
227 	 * Nexus drivers with such exceptions (e.g. pci ranges)
228 	 * should either create a separate function for handling
229 	 * ranges or not use parent private data to store ranges.
230 	 */
231 
232 	/* root node has no ranges */
233 	if ((parent = ddi_get_parent(child)) == NULL)
234 		return;
235 
236 	child_addr_cells = ddi_prop_get_int(DDI_DEV_T_ANY, child,
237 	    DDI_PROP_DONTPASS, "#address-cells", 2);
238 	child_size_cells = ddi_prop_get_int(DDI_DEV_T_ANY, child,
239 	    DDI_PROP_DONTPASS, "#size-cells", 1);
240 	parent_addr_cells = ddi_prop_get_int(DDI_DEV_T_ANY, parent,
241 	    DDI_PROP_DONTPASS, "#address-cells", 2);
242 	parent_size_cells = ddi_prop_get_int(DDI_DEV_T_ANY, parent,
243 	    DDI_PROP_DONTPASS, "#size-cells", 1);
244 	if (child_addr_cells != 2 || parent_addr_cells != 2 ||
245 	    (child_size_cells != 1 && parent_size_cells != 1)) {
246 		NDI_CONFIG_DEBUG((CE_NOTE, "!ranges not made in parent data; "
247 		    "#address-cells or #size-cells have non-default value"));
248 		return;
249 	}
250 
251 	if (get_prop_int_array(child, OBP_RANGES, &rng_prop, &rng_len)
252 	    == DDI_PROP_SUCCESS) {
253 		pdptr->par_nrng = rng_len / (int)(sizeof (struct rangespec));
254 		pdptr->par_rng = (struct rangespec *)rng_prop;
255 	}
256 }
257 
258 /*
259  * Free ddi_parent_private_data structure
260  */
261 void
262 impl_free_ddi_ppd(dev_info_t *dip)
263 {
264 	struct ddi_parent_private_data *pdptr = ddi_get_parent_data(dip);
265 
266 	if (pdptr == NULL)
267 		return;
268 
269 	if (pdptr->par_nrng != 0)
270 		ddi_prop_free((void *)pdptr->par_rng);
271 
272 	if (pdptr->par_nreg != 0)
273 		ddi_prop_free((void *)pdptr->par_reg);
274 
275 	kmem_free(pdptr, sizeof (*pdptr));
276 	ddi_set_parent_data(dip, NULL);
277 }
278 
279 /*
280  * Name a child of sun busses based on the reg spec.
281  * Handles the following properties:
282  *
283  *	Property	value
284  *	Name		type
285  *
286  *	reg		register spec
287  *	interrupts	new (bus-oriented) interrupt spec
288  *	ranges		range spec
289  *
290  * This may be called multiple times, independent of
291  * initchild calls.
292  */
293 static int
294 impl_sunbus_name_child(dev_info_t *child, char *name, int namelen)
295 {
296 	struct ddi_parent_private_data *pdptr;
297 	struct regspec *rp;
298 
299 	/*
300 	 * Fill in parent-private data and this function returns to us
301 	 * an indication if it used "registers" to fill in the data.
302 	 */
303 	if (ddi_get_parent_data(child) == NULL) {
304 		make_ddi_ppd(child, &pdptr);
305 		ddi_set_parent_data(child, pdptr);
306 	}
307 
308 	/*
309 	 * No reg property, return null string as address
310 	 * (e.g. root node)
311 	 */
312 	name[0] = '\0';
313 	if (sparc_pd_getnreg(child) == 0) {
314 		return (DDI_SUCCESS);
315 	}
316 
317 	rp = sparc_pd_getreg(child, 0);
318 	(void) snprintf(name, namelen, "%x,%x",
319 	    rp->regspec_bustype, rp->regspec_addr);
320 	return (DDI_SUCCESS);
321 }
322 
323 
324 /*
325  * Called from the bus_ctl op of some drivers.
326  * to implement the DDI_CTLOPS_INITCHILD operation.
327  *
328  * NEW drivers should NOT use this function, but should declare
329  * there own initchild/uninitchild handlers. (This function assumes
330  * the layout of the parent private data and the format of "reg",
331  * "ranges", "interrupts" properties and that #address-cells and
332  * #size-cells of the parent bus are defined to be default values.)
333  */
334 int
335 impl_ddi_sunbus_initchild(dev_info_t *child)
336 {
337 	char name[MAXNAMELEN];
338 
339 	(void) impl_sunbus_name_child(child, name, MAXNAMELEN);
340 	ddi_set_name_addr(child, name);
341 
342 	/*
343 	 * Try to merge .conf node. If successful, return failure to
344 	 * remove this child.
345 	 */
346 	if ((ndi_dev_is_persistent_node(child) == 0) &&
347 	    (ndi_merge_node(child, impl_sunbus_name_child) == DDI_SUCCESS)) {
348 		impl_ddi_sunbus_removechild(child);
349 		return (DDI_FAILURE);
350 	}
351 	return (DDI_SUCCESS);
352 }
353 
354 /*
355  * A better name for this function would be impl_ddi_sunbus_uninitchild()
356  * It does not remove the child, it uninitializes it, reclaiming the
357  * resources taken by impl_ddi_sunbus_initchild.
358  */
359 void
360 impl_ddi_sunbus_removechild(dev_info_t *dip)
361 {
362 	impl_free_ddi_ppd(dip);
363 	ddi_set_name_addr(dip, NULL);
364 	/*
365 	 * Strip the node to properly convert it back to prototype form
366 	 */
367 	impl_rem_dev_props(dip);
368 }
369 
370 /*
371  * SECTION: DDI Interrupt
372  */
373 
374 void
375 cells_1275_copy(prop_1275_cell_t *from, prop_1275_cell_t *to, int32_t len)
376 {
377 	int i;
378 	for (i = 0; i < len; i++)
379 		*to = *from;
380 }
381 
382 prop_1275_cell_t *
383 cells_1275_cmp(prop_1275_cell_t *cell1, prop_1275_cell_t *cell2, int32_t len)
384 {
385 	prop_1275_cell_t *match_cell = 0;
386 	int32_t i;
387 
388 	for (i = 0; i < len; i++)
389 		if (cell1[i] != cell2[i]) {
390 			match_cell = &cell1[i];
391 			break;
392 		}
393 
394 	return (match_cell);
395 }
396 
397 /*
398  * get_intr_parent() is a generic routine that process a 1275 interrupt
399  * map (imap) property.  This function returns a dev_info_t structure
400  * which claims ownership of the interrupt domain.
401  * It also returns the new interrupt translation within this new domain.
402  * If an interrupt-parent or interrupt-map property are not found,
403  * then we fallback to using the device tree's parent.
404  *
405  * imap entry format:
406  * <reg>,<interrupt>,<phandle>,<translated interrupt>
407  * reg - The register specification in the interrupts domain
408  * interrupt - The interrupt specification
409  * phandle - PROM handle of the device that owns the xlated interrupt domain
410  * translated interrupt - interrupt specifier in the parents domain
411  * note: <reg>,<interrupt> - The reg and interrupt can be combined to create
412  *	a unique entry called a unit interrupt specifier.
413  *
414  * Here's the processing steps:
415  * step1 - If the interrupt-parent property exists, create the ispec and
416  *	return the dip of the interrupt parent.
417  * step2 - Extract the interrupt-map property and the interrupt-map-mask
418  *	If these don't exist, just return the device tree parent.
419  * step3 - build up the unit interrupt specifier to match against the
420  *	interrupt map property
421  * step4 - Scan the interrupt-map property until a match is found
422  * step4a - Extract the interrupt parent
423  * step4b - Compare the unit interrupt specifier
424  */
425 dev_info_t *
426 get_intr_parent(dev_info_t *pdip, dev_info_t *dip, ddi_intr_handle_impl_t *hdlp)
427 {
428 	prop_1275_cell_t *imap, *imap_mask, *scan, *reg_p, *match_req;
429 	int32_t imap_sz, imap_cells, imap_scan_cells, imap_mask_sz,
430 	    addr_cells, intr_cells, reg_len, i, j;
431 	int32_t match_found = 0;
432 	dev_info_t *intr_parent_dip = NULL;
433 	uint32_t *intr = &hdlp->ih_vector;
434 	uint32_t nodeid;
435 #ifdef DEBUG
436 	static int debug = 0;
437 #endif
438 
439 	/*
440 	 * step1
441 	 * If we have an interrupt-parent property, this property represents
442 	 * the nodeid of our interrupt parent.
443 	 */
444 	if ((nodeid = ddi_getprop(DDI_DEV_T_ANY, dip, 0,
445 	    "interrupt-parent", -1)) != -1) {
446 		intr_parent_dip = e_ddi_nodeid_to_dip(nodeid);
447 		ASSERT(intr_parent_dip);
448 
449 		/*
450 		 * Attach the interrupt parent.
451 		 *
452 		 * N.B. e_ddi_nodeid_to_dip() isn't safe under DR.
453 		 *	Also, interrupt parent isn't held. This needs
454 		 *	to be revisited if DR-capable platforms implement
455 		 *	interrupt redirection.
456 		 */
457 		if (i_ddi_attach_node_hierarchy(intr_parent_dip)
458 		    != DDI_SUCCESS) {
459 			ndi_rele_devi(intr_parent_dip);
460 			return (NULL);
461 		}
462 
463 		return (intr_parent_dip);
464 	}
465 
466 	/*
467 	 * step2
468 	 * Get interrupt map structure from PROM property
469 	 */
470 	if (ddi_getlongprop(DDI_DEV_T_ANY, pdip, DDI_PROP_DONTPASS,
471 	    "interrupt-map", (caddr_t)&imap, &imap_sz)
472 	    != DDI_PROP_SUCCESS) {
473 		/*
474 		 * If we don't have an imap property, default to using the
475 		 * device tree.
476 		 */
477 
478 		ndi_hold_devi(pdip);
479 		return (pdip);
480 	}
481 
482 	/* Get the interrupt mask property */
483 	if (ddi_getlongprop(DDI_DEV_T_ANY, pdip, DDI_PROP_DONTPASS,
484 	    "interrupt-map-mask", (caddr_t)&imap_mask, &imap_mask_sz)
485 	    != DDI_PROP_SUCCESS) {
486 		/*
487 		 * If we don't find this property, we have to fail the request
488 		 * because the 1275 imap property wasn't defined correctly.
489 		 */
490 		ASSERT(intr_parent_dip == NULL);
491 		goto exit2;
492 	}
493 
494 	/* Get the address cell size */
495 	addr_cells = ddi_getprop(DDI_DEV_T_ANY, pdip, 0,
496 	    "#address-cells", 2);
497 
498 	/* Get the interrupts cell size */
499 	intr_cells = ddi_getprop(DDI_DEV_T_ANY, pdip, 0,
500 	    "#interrupt-cells", 1);
501 
502 	/*
503 	 * step3
504 	 * Now lets build up the unit interrupt specifier e.g. reg,intr
505 	 * and apply the imap mask.  match_req will hold this when we're
506 	 * through.
507 	 */
508 	if (ddi_getlongprop(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS, "reg",
509 	    (caddr_t)&reg_p, &reg_len) != DDI_SUCCESS) {
510 		ASSERT(intr_parent_dip == NULL);
511 		goto exit3;
512 	}
513 
514 	match_req = kmem_alloc(CELLS_1275_TO_BYTES(addr_cells) +
515 	    CELLS_1275_TO_BYTES(intr_cells), KM_SLEEP);
516 
517 	for (i = 0; i < addr_cells; i++)
518 		match_req[i] = (reg_p[i] & imap_mask[i]);
519 
520 	for (j = 0; j < intr_cells; i++, j++)
521 		match_req[i] = (intr[j] & imap_mask[i]);
522 
523 	/* Calculate the imap size in cells */
524 	imap_cells = BYTES_TO_1275_CELLS(imap_sz);
525 
526 #ifdef DEBUG
527 	if (debug)
528 		prom_printf("reg cell size 0x%x, intr cell size 0x%x, "
529 		    "match_request 0x%p, imap 0x%p\n", addr_cells, intr_cells,
530 		    (void *)match_req, (void *)imap);
531 #endif
532 
533 	/*
534 	 * Scan the imap property looking for a match of the interrupt unit
535 	 * specifier.  This loop is rather complex since the data within the
536 	 * imap property may vary in size.
537 	 */
538 	for (scan = imap, imap_scan_cells = i = 0;
539 	    imap_scan_cells < imap_cells; scan += i, imap_scan_cells += i) {
540 		int new_intr_cells;
541 
542 		/* Set the index to the nodeid field */
543 		i = addr_cells + intr_cells;
544 
545 		/*
546 		 * step4a
547 		 * Translate the nodeid field to a dip
548 		 */
549 		ASSERT(intr_parent_dip == NULL);
550 		intr_parent_dip = e_ddi_nodeid_to_dip((uint_t)scan[i++]);
551 
552 		ASSERT(intr_parent_dip != 0);
553 #ifdef DEBUG
554 		if (debug)
555 			prom_printf("scan 0x%p\n", (void *)scan);
556 #endif
557 		/*
558 		 * The tmp_dip describes the new domain, get it's interrupt
559 		 * cell size
560 		 */
561 		new_intr_cells = ddi_getprop(DDI_DEV_T_ANY, intr_parent_dip, 0,
562 		    "#interrupts-cells", 1);
563 
564 		/*
565 		 * step4b
566 		 * See if we have a match on the interrupt unit specifier
567 		 */
568 		if (cells_1275_cmp(match_req, scan, addr_cells + intr_cells)
569 		    == 0) {
570 			uint32_t *intr;
571 
572 			match_found = 1;
573 
574 			/*
575 			 * If we have an imap parent whose not in our device
576 			 * tree path, we need to hold and install that driver.
577 			 */
578 			if (i_ddi_attach_node_hierarchy(intr_parent_dip)
579 			    != DDI_SUCCESS) {
580 				ndi_rele_devi(intr_parent_dip);
581 				intr_parent_dip = (dev_info_t *)NULL;
582 				goto exit4;
583 			}
584 
585 			/*
586 			 * We need to handcraft an ispec along with a bus
587 			 * interrupt value, so we can dup it into our
588 			 * standard ispec structure.
589 			 */
590 			/* Extract the translated interrupt information */
591 			intr = kmem_alloc(
592 			    CELLS_1275_TO_BYTES(new_intr_cells), KM_SLEEP);
593 
594 			for (j = 0; j < new_intr_cells; j++, i++)
595 				intr[j] = scan[i];
596 
597 			cells_1275_copy(intr, &hdlp->ih_vector, new_intr_cells);
598 
599 			kmem_free(intr, CELLS_1275_TO_BYTES(new_intr_cells));
600 
601 #ifdef DEBUG
602 			if (debug)
603 				prom_printf("dip 0x%p\n",
604 				    (void *)intr_parent_dip);
605 #endif
606 			break;
607 		} else {
608 #ifdef DEBUG
609 			if (debug)
610 				prom_printf("dip 0x%p\n",
611 				    (void *)intr_parent_dip);
612 #endif
613 			ndi_rele_devi(intr_parent_dip);
614 			intr_parent_dip = NULL;
615 			i += new_intr_cells;
616 		}
617 	}
618 
619 	/*
620 	 * If we haven't found our interrupt parent at this point, fallback
621 	 * to using the device tree.
622 	 */
623 	if (!match_found) {
624 		ndi_hold_devi(pdip);
625 		ASSERT(intr_parent_dip == NULL);
626 		intr_parent_dip = pdip;
627 	}
628 
629 	ASSERT(intr_parent_dip != NULL);
630 
631 exit4:
632 	kmem_free(reg_p, reg_len);
633 	kmem_free(match_req, CELLS_1275_TO_BYTES(addr_cells) +
634 	    CELLS_1275_TO_BYTES(intr_cells));
635 
636 exit3:
637 	kmem_free(imap_mask, imap_mask_sz);
638 
639 exit2:
640 	kmem_free(imap, imap_sz);
641 
642 	return (intr_parent_dip);
643 }
644 
645 /*
646  * process_intr_ops:
647  *
648  * Process the interrupt op via the interrupt parent.
649  */
650 int
651 process_intr_ops(dev_info_t *pdip, dev_info_t *rdip, ddi_intr_op_t op,
652     ddi_intr_handle_impl_t *hdlp, void *result)
653 {
654 	int		ret = DDI_FAILURE;
655 
656 	if (NEXUS_HAS_INTR_OP(pdip)) {
657 		ret = (*(DEVI(pdip)->devi_ops->devo_bus_ops->
658 		    bus_intr_op)) (pdip, rdip, op, hdlp, result);
659 	} else {
660 		cmn_err(CE_WARN, "Failed to process interrupt "
661 		    "for %s%d due to down-rev nexus driver %s%d",
662 		    ddi_get_name(rdip), ddi_get_instance(rdip),
663 		    ddi_get_name(pdip), ddi_get_instance(pdip));
664 	}
665 
666 	return (ret);
667 }
668 
669 /*ARGSUSED*/
670 uint_t
671 softlevel1(caddr_t arg)
672 {
673 	softint();
674 	return (1);
675 }
676 
677 /*
678  * indirection table, to save us some large switch statements
679  * NOTE: This must agree with "INTLEVEL_foo" constants in
680  *	<sys/avintr.h>
681  */
682 struct autovec *const vectorlist[] = { 0 };
683 
684 /*
685  * This value is exported here for the functions in avintr.c
686  */
687 const uint_t maxautovec = (sizeof (vectorlist) / sizeof (vectorlist[0]));
688 
689 /*
690  * Check for machine specific interrupt levels which cannot be reassigned by
691  * settrap(), sun4u version.
692  *
693  * sun4u does not support V8 SPARC "fast trap" handlers.
694  */
695 /*ARGSUSED*/
696 int
697 exclude_settrap(int lvl)
698 {
699 	return (1);
700 }
701 
702 /*
703  * Check for machine specific interrupt levels which cannot have interrupt
704  * handlers added. We allow levels 1 through 15; level 0 is nonsense.
705  */
706 /*ARGSUSED*/
707 int
708 exclude_level(int lvl)
709 {
710 	return ((lvl < 1) || (lvl > 15));
711 }
712 
713 /*
714  * Wrapper functions used by New DDI interrupt framework.
715  */
716 
717 /*
718  * i_ddi_intr_ops:
719  */
720 int
721 i_ddi_intr_ops(dev_info_t *dip, dev_info_t *rdip, ddi_intr_op_t op,
722     ddi_intr_handle_impl_t *hdlp, void *result)
723 {
724 	dev_info_t	*pdip = ddi_get_parent(dip);
725 	int		ret = DDI_FAILURE;
726 
727 	/*
728 	 * The following check is required to address
729 	 * one of the test case of ADDI test suite.
730 	 */
731 	if (pdip == NULL)
732 		return (DDI_FAILURE);
733 
734 	if (hdlp->ih_type != DDI_INTR_TYPE_FIXED)
735 		return (process_intr_ops(pdip, rdip, op, hdlp, result));
736 
737 	if (hdlp->ih_vector == 0)
738 		hdlp->ih_vector = i_ddi_get_inum(rdip, hdlp->ih_inum);
739 
740 	if (hdlp->ih_pri == 0)
741 		hdlp->ih_pri = i_ddi_get_intr_pri(rdip, hdlp->ih_inum);
742 
743 	switch (op) {
744 	case DDI_INTROP_ADDISR:
745 	case DDI_INTROP_REMISR:
746 	case DDI_INTROP_GETTARGET:
747 	case DDI_INTROP_SETTARGET:
748 	case DDI_INTROP_ENABLE:
749 	case DDI_INTROP_DISABLE:
750 	case DDI_INTROP_BLOCKENABLE:
751 	case DDI_INTROP_BLOCKDISABLE:
752 		/*
753 		 * Try and determine our parent and possibly an interrupt
754 		 * translation. intr parent dip returned held
755 		 */
756 		if ((pdip = get_intr_parent(pdip, dip, hdlp)) == NULL)
757 			goto done;
758 	}
759 
760 	ret = process_intr_ops(pdip, rdip, op, hdlp, result);
761 
762 done:
763 	switch (op) {
764 	case DDI_INTROP_ADDISR:
765 	case DDI_INTROP_REMISR:
766 	case DDI_INTROP_ENABLE:
767 	case DDI_INTROP_DISABLE:
768 	case DDI_INTROP_BLOCKENABLE:
769 	case DDI_INTROP_BLOCKDISABLE:
770 		/* Release hold acquired in get_intr_parent() */
771 		if (pdip)
772 			ndi_rele_devi(pdip);
773 	}
774 
775 	hdlp->ih_vector = 0;
776 
777 	return (ret);
778 }
779 
780 /*
781  * i_ddi_add_ivintr:
782  */
783 /*ARGSUSED*/
784 int
785 i_ddi_add_ivintr(ddi_intr_handle_impl_t *hdlp)
786 {
787 	/*
788 	 * If the PIL was set and is valid use it, otherwise
789 	 * default it to 1
790 	 */
791 	if ((hdlp->ih_pri < 1) || (hdlp->ih_pri > PIL_MAX))
792 		hdlp->ih_pri = 1;
793 
794 	VERIFY(add_ivintr(hdlp->ih_vector, hdlp->ih_pri,
795 	    (intrfunc)hdlp->ih_cb_func, hdlp->ih_cb_arg1,
796 	    hdlp->ih_cb_arg2, NULL) == 0);
797 
798 	return (DDI_SUCCESS);
799 }
800 
801 /*
802  * i_ddi_rem_ivintr:
803  */
804 /*ARGSUSED*/
805 void
806 i_ddi_rem_ivintr(ddi_intr_handle_impl_t *hdlp)
807 {
808 	VERIFY(rem_ivintr(hdlp->ih_vector, hdlp->ih_pri) == 0);
809 }
810 
811 /*
812  * i_ddi_get_inum - Get the interrupt number property from the
813  * specified device. Note that this function is called only for
814  * the FIXED interrupt type.
815  */
816 uint32_t
817 i_ddi_get_inum(dev_info_t *dip, uint_t inumber)
818 {
819 	int32_t			intrlen, intr_cells, max_intrs;
820 	prop_1275_cell_t	*ip, intr_sz;
821 	uint32_t		intr = 0;
822 
823 	if (ddi_getlongprop(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS |
824 	    DDI_PROP_CANSLEEP,
825 	    "interrupts", (caddr_t)&ip, &intrlen) == DDI_SUCCESS) {
826 
827 		intr_cells = ddi_getprop(DDI_DEV_T_ANY, dip, 0,
828 		    "#interrupt-cells", 1);
829 
830 		/* adjust for number of bytes */
831 		intr_sz = CELLS_1275_TO_BYTES(intr_cells);
832 
833 		/* Calculate the number of interrupts */
834 		max_intrs = intrlen / intr_sz;
835 
836 		if (inumber < max_intrs) {
837 			prop_1275_cell_t *intrp = ip;
838 
839 			/* Index into interrupt property */
840 			intrp += (inumber * intr_cells);
841 
842 			cells_1275_copy(intrp, &intr, intr_cells);
843 		}
844 
845 		kmem_free(ip, intrlen);
846 	}
847 
848 	return (intr);
849 }
850 
851 /*
852  * i_ddi_get_intr_pri - Get the interrupt-priorities property from
853  * the specified device. Note that this function is called only for
854  * the FIXED interrupt type.
855  */
856 uint32_t
857 i_ddi_get_intr_pri(dev_info_t *dip, uint_t inumber)
858 {
859 	uint32_t	*intr_prio_p;
860 	uint32_t	pri = 0;
861 	int32_t		i;
862 
863 	/*
864 	 * Use the "interrupt-priorities" property to determine the
865 	 * the pil/ipl for the interrupt handler.
866 	 */
867 	if (ddi_getlongprop(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS,
868 	    "interrupt-priorities", (caddr_t)&intr_prio_p,
869 	    &i) == DDI_SUCCESS) {
870 		if (inumber < (i / sizeof (int32_t)))
871 			pri = intr_prio_p[inumber];
872 		kmem_free(intr_prio_p, i);
873 	}
874 
875 	return (pri);
876 }
877 
878 int
879 i_ddi_get_intx_nintrs(dev_info_t *dip)
880 {
881 	int32_t intrlen;
882 	prop_1275_cell_t intr_sz;
883 	prop_1275_cell_t *ip;
884 	int32_t ret = 0;
885 
886 	if (ddi_getlongprop(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS |
887 	    DDI_PROP_CANSLEEP,
888 	    "interrupts", (caddr_t)&ip, &intrlen) == DDI_SUCCESS) {
889 
890 		intr_sz = ddi_getprop(DDI_DEV_T_ANY, dip, 0,
891 		    "#interrupt-cells", 1);
892 		/* adjust for number of bytes */
893 		intr_sz = CELLS_1275_TO_BYTES(intr_sz);
894 
895 		ret = intrlen / intr_sz;
896 
897 		kmem_free(ip, intrlen);
898 	}
899 
900 	return (ret);
901 }
902 
903 /*
904  * i_ddi_add_softint - allocate and add a software interrupt.
905  *
906  * NOTE: All software interrupts that are registered through DDI
907  *	 should be triggered only on a single target or CPU.
908  */
909 int
910 i_ddi_add_softint(ddi_softint_hdl_impl_t *hdlp)
911 {
912 	if ((hdlp->ih_private = (void *)add_softintr(hdlp->ih_pri,
913 	    hdlp->ih_cb_func, hdlp->ih_cb_arg1, SOFTINT_ST)) == NULL)
914 		return (DDI_FAILURE);
915 
916 	return (DDI_SUCCESS);
917 }
918 
919 /*
920  * i_ddi_remove_softint - remove and free a software interrupt.
921  */
922 void
923 i_ddi_remove_softint(ddi_softint_hdl_impl_t *hdlp)
924 {
925 	ASSERT(hdlp->ih_private != NULL);
926 
927 	if (rem_softintr((uint64_t)hdlp->ih_private) == 0)
928 		hdlp->ih_private = NULL;
929 }
930 
931 /*
932  * i_ddi_trigger_softint - trigger a software interrupt.
933  */
934 int
935 i_ddi_trigger_softint(ddi_softint_hdl_impl_t *hdlp, void *arg2)
936 {
937 	int	ret;
938 
939 	ASSERT(hdlp->ih_private != NULL);
940 
941 	/* Update the second argument for the software interrupt */
942 	if ((ret = update_softint_arg2((uint64_t)hdlp->ih_private, arg2)) == 0)
943 		setsoftint((uint64_t)hdlp->ih_private);
944 
945 	return (ret ? DDI_EPENDING : DDI_SUCCESS);
946 }
947 
948 /*
949  * i_ddi_set_softint_pri - change software interrupt priority.
950  */
951 /* ARGSUSED */
952 int
953 i_ddi_set_softint_pri(ddi_softint_hdl_impl_t *hdlp, uint_t old_pri)
954 {
955 	int	ret;
956 
957 	ASSERT(hdlp->ih_private != NULL);
958 
959 	/* Update the interrupt priority for the software interrupt */
960 	ret = update_softint_pri((uint64_t)hdlp->ih_private, hdlp->ih_pri);
961 
962 	return (ret ? DDI_FAILURE : DDI_SUCCESS);
963 }
964 
965 /*ARGSUSED*/
966 void
967 i_ddi_alloc_intr_phdl(ddi_intr_handle_impl_t *hdlp)
968 {
969 }
970 
971 /*ARGSUSED*/
972 void
973 i_ddi_free_intr_phdl(ddi_intr_handle_impl_t *hdlp)
974 {
975 }
976 
977 /*
978  * SECTION: DDI Memory/DMA
979  */
980 
981 /* set HAT endianess attributes from ddi_device_acc_attr */
982 void
983 i_ddi_devacc_to_hatacc(ddi_device_acc_attr_t *devaccp, uint_t *hataccp)
984 {
985 	if (devaccp != NULL) {
986 		if (devaccp->devacc_attr_endian_flags == DDI_STRUCTURE_LE_ACC) {
987 			*hataccp &= ~HAT_ENDIAN_MASK;
988 			*hataccp |= HAT_STRUCTURE_LE;
989 		}
990 	}
991 }
992 
993 /*
994  * Check if the specified cache attribute is supported on the platform.
995  * This function must be called before i_ddi_cacheattr_to_hatacc().
996  */
997 boolean_t
998 i_ddi_check_cache_attr(uint_t flags)
999 {
1000 	/*
1001 	 * The cache attributes are mutually exclusive. Any combination of
1002 	 * the attributes leads to a failure.
1003 	 */
1004 	uint_t cache_attr = IOMEM_CACHE_ATTR(flags);
1005 	if ((cache_attr != 0) && ((cache_attr & (cache_attr - 1)) != 0))
1006 		return (B_FALSE);
1007 
1008 	/*
1009 	 * On the sparc architecture, only IOMEM_DATA_CACHED is meaningful,
1010 	 * but others lead to a failure.
1011 	 */
1012 	if (cache_attr & IOMEM_DATA_CACHED)
1013 		return (B_TRUE);
1014 	else
1015 		return (B_FALSE);
1016 }
1017 
1018 /* set HAT cache attributes from the cache attributes */
1019 void
1020 i_ddi_cacheattr_to_hatacc(uint_t flags, uint_t *hataccp)
1021 {
1022 	uint_t cache_attr = IOMEM_CACHE_ATTR(flags);
1023 	static char *fname = "i_ddi_cacheattr_to_hatacc";
1024 #if defined(lint)
1025 	*hataccp = *hataccp;
1026 #endif
1027 	/*
1028 	 * set HAT attrs according to the cache attrs.
1029 	 */
1030 	switch (cache_attr) {
1031 	/*
1032 	 * The cache coherency is always maintained on SPARC, and
1033 	 * nothing is required.
1034 	 */
1035 	case IOMEM_DATA_CACHED:
1036 		break;
1037 	/*
1038 	 * Both IOMEM_DATA_UC_WRITE_COMBINED and IOMEM_DATA_UNCACHED are
1039 	 * not supported on SPARC -- this case must not occur because the
1040 	 * cache attribute is scrutinized before this function is called.
1041 	 */
1042 	case IOMEM_DATA_UNCACHED:
1043 	case IOMEM_DATA_UC_WR_COMBINE:
1044 	default:
1045 		cmn_err(CE_WARN, "%s: cache_attr=0x%x is ignored.",
1046 		    fname, cache_attr);
1047 	}
1048 }
1049 
1050 static vmem_t *little_endian_arena;
1051 static vmem_t *big_endian_arena;
1052 
1053 static void *
1054 segkmem_alloc_le(vmem_t *vmp, size_t size, int flag)
1055 {
1056 	return (segkmem_xalloc(vmp, NULL, size, flag, HAT_STRUCTURE_LE,
1057 	    segkmem_page_create, NULL));
1058 }
1059 
1060 static void *
1061 segkmem_alloc_be(vmem_t *vmp, size_t size, int flag)
1062 {
1063 	return (segkmem_xalloc(vmp, NULL, size, flag, HAT_STRUCTURE_BE,
1064 	    segkmem_page_create, NULL));
1065 }
1066 
1067 void
1068 ka_init(void)
1069 {
1070 	little_endian_arena = vmem_create("little_endian", NULL, 0, 1,
1071 	    segkmem_alloc_le, segkmem_free, heap_arena, 0, VM_SLEEP);
1072 	big_endian_arena = vmem_create("big_endian", NULL, 0, 1,
1073 	    segkmem_alloc_be, segkmem_free, heap_arena, 0, VM_SLEEP);
1074 }
1075 
1076 /*
1077  * Allocate from the system, aligned on a specific boundary.
1078  * The alignment, if non-zero, must be a power of 2.
1079  */
1080 static void *
1081 kalloca(size_t size, size_t align, int cansleep, uint_t endian_flags)
1082 {
1083 	size_t *addr, *raddr, rsize;
1084 	size_t hdrsize = 4 * sizeof (size_t);	/* must be power of 2 */
1085 
1086 	align = MAX(align, hdrsize);
1087 	ASSERT((align & (align - 1)) == 0);
1088 
1089 	/*
1090 	 * We need to allocate
1091 	 *    rsize = size + hdrsize + align - MIN(hdrsize, buffer_alignment)
1092 	 * bytes to be sure we have enough freedom to satisfy the request.
1093 	 * Since the buffer alignment depends on the request size, this is
1094 	 * not straightforward to use directly.
1095 	 *
1096 	 * kmem guarantees that any allocation of a 64-byte multiple will be
1097 	 * 64-byte aligned.  Since rounding up the request could add more
1098 	 * than we save, we compute the size with and without alignment, and
1099 	 * use the smaller of the two.
1100 	 */
1101 	rsize = size + hdrsize + align;
1102 
1103 	if (endian_flags == DDI_STRUCTURE_LE_ACC) {
1104 		raddr = vmem_alloc(little_endian_arena, rsize,
1105 		    cansleep ? VM_SLEEP : VM_NOSLEEP);
1106 	} else {
1107 		raddr = vmem_alloc(big_endian_arena, rsize,
1108 		    cansleep ? VM_SLEEP : VM_NOSLEEP);
1109 	}
1110 
1111 	if (raddr == NULL)
1112 		return (NULL);
1113 
1114 	addr = (size_t *)P2ROUNDUP((uintptr_t)raddr + hdrsize, align);
1115 	ASSERT((uintptr_t)addr + size - (uintptr_t)raddr <= rsize);
1116 
1117 	addr[-3] = (size_t)endian_flags;
1118 	addr[-2] = (size_t)raddr;
1119 	addr[-1] = rsize;
1120 
1121 	return (addr);
1122 }
1123 
1124 static void
1125 kfreea(void *addr)
1126 {
1127 	size_t *saddr = addr;
1128 
1129 	if (saddr[-3] == DDI_STRUCTURE_LE_ACC)
1130 		vmem_free(little_endian_arena, (void *)saddr[-2], saddr[-1]);
1131 	else
1132 		vmem_free(big_endian_arena, (void *)saddr[-2], saddr[-1]);
1133 }
1134 
1135 int
1136 i_ddi_mem_alloc(dev_info_t *dip, ddi_dma_attr_t *attr,
1137     size_t length, int cansleep, int flags,
1138     ddi_device_acc_attr_t *accattrp,
1139     caddr_t *kaddrp, size_t *real_length, ddi_acc_hdl_t *handlep)
1140 {
1141 	caddr_t a;
1142 	int iomin, align, streaming;
1143 	uint_t endian_flags = DDI_NEVERSWAP_ACC;
1144 
1145 #if defined(lint)
1146 	*handlep = *handlep;
1147 #endif
1148 
1149 	/*
1150 	 * Check legality of arguments
1151 	 */
1152 	if (length == 0 || kaddrp == NULL || attr == NULL) {
1153 		return (DDI_FAILURE);
1154 	}
1155 
1156 	if (attr->dma_attr_minxfer == 0 || attr->dma_attr_align == 0 ||
1157 	    (attr->dma_attr_align & (attr->dma_attr_align - 1)) ||
1158 	    (attr->dma_attr_minxfer & (attr->dma_attr_minxfer - 1))) {
1159 		return (DDI_FAILURE);
1160 	}
1161 
1162 	/*
1163 	 * check if a streaming sequential xfer is requested.
1164 	 */
1165 	streaming = (flags & DDI_DMA_STREAMING) ? 1 : 0;
1166 
1167 	/*
1168 	 * Drivers for 64-bit capable SBus devices will encode
1169 	 * the burtsizes for 64-bit xfers in the upper 16-bits.
1170 	 * For DMA alignment, we use the most restrictive
1171 	 * alignment of 32-bit and 64-bit xfers.
1172 	 */
1173 	iomin = (attr->dma_attr_burstsizes & 0xffff) |
1174 	    ((attr->dma_attr_burstsizes >> 16) & 0xffff);
1175 	/*
1176 	 * If a driver set burtsizes to 0, we give him byte alignment.
1177 	 * Otherwise align at the burtsizes boundary.
1178 	 */
1179 	if (iomin == 0)
1180 		iomin = 1;
1181 	else
1182 		iomin = 1 << (ddi_fls(iomin) - 1);
1183 	iomin = maxbit(iomin, attr->dma_attr_minxfer);
1184 	iomin = maxbit(iomin, attr->dma_attr_align);
1185 	iomin = ddi_iomin(dip, iomin, streaming);
1186 	if (iomin == 0)
1187 		return (DDI_FAILURE);
1188 
1189 	ASSERT((iomin & (iomin - 1)) == 0);
1190 	ASSERT(iomin >= attr->dma_attr_minxfer);
1191 	ASSERT(iomin >= attr->dma_attr_align);
1192 
1193 	length = P2ROUNDUP(length, iomin);
1194 	align = iomin;
1195 
1196 	if (accattrp != NULL)
1197 		endian_flags = accattrp->devacc_attr_endian_flags;
1198 
1199 	a = kalloca(length, align, cansleep, endian_flags);
1200 	if ((*kaddrp = a) == 0) {
1201 		return (DDI_FAILURE);
1202 	} else {
1203 		if (real_length) {
1204 			*real_length = length;
1205 		}
1206 		if (handlep) {
1207 			/*
1208 			 * assign handle information
1209 			 */
1210 			impl_acc_hdl_init(handlep);
1211 		}
1212 		return (DDI_SUCCESS);
1213 	}
1214 }
1215 
1216 /*
1217  * covert old DMA limits structure to DMA attribute structure
1218  * and continue
1219  */
1220 int
1221 i_ddi_mem_alloc_lim(dev_info_t *dip, ddi_dma_lim_t *limits,
1222     size_t length, int cansleep, int streaming,
1223     ddi_device_acc_attr_t *accattrp, caddr_t *kaddrp,
1224     uint_t *real_length, ddi_acc_hdl_t *ap)
1225 {
1226 	ddi_dma_attr_t dma_attr, *attrp;
1227 	size_t rlen;
1228 	int ret;
1229 
1230 	ASSERT(limits);
1231 	attrp = &dma_attr;
1232 	attrp->dma_attr_version = DMA_ATTR_V0;
1233 	attrp->dma_attr_addr_lo = (uint64_t)limits->dlim_addr_lo;
1234 	attrp->dma_attr_addr_hi = (uint64_t)limits->dlim_addr_hi;
1235 	attrp->dma_attr_count_max = (uint64_t)-1;
1236 	attrp->dma_attr_align = 1;
1237 	attrp->dma_attr_burstsizes = (uint_t)limits->dlim_burstsizes;
1238 	attrp->dma_attr_minxfer = (uint32_t)limits->dlim_minxfer;
1239 	attrp->dma_attr_maxxfer = (uint64_t)-1;
1240 	attrp->dma_attr_seg = (uint64_t)limits->dlim_cntr_max;
1241 	attrp->dma_attr_sgllen = 1;
1242 	attrp->dma_attr_granular = 1;
1243 	attrp->dma_attr_flags = 0;
1244 
1245 	ret = i_ddi_mem_alloc(dip, attrp, length, cansleep, streaming,
1246 	    accattrp, kaddrp, &rlen, ap);
1247 	if (ret == DDI_SUCCESS) {
1248 		if (real_length)
1249 			*real_length = (uint_t)rlen;
1250 	}
1251 	return (ret);
1252 }
1253 
1254 /* ARGSUSED */
1255 void
1256 i_ddi_mem_free(caddr_t kaddr, ddi_acc_hdl_t *ap)
1257 {
1258 	kfreea(kaddr);
1259 }
1260 
1261 /*
1262  * SECTION: DDI Data Access
1263  */
1264 
1265 static uintptr_t impl_acc_hdl_id = 0;
1266 
1267 /*
1268  * access handle allocator
1269  */
1270 ddi_acc_hdl_t *
1271 impl_acc_hdl_get(ddi_acc_handle_t hdl)
1272 {
1273 	/*
1274 	 * Extract the access handle address from the DDI implemented
1275 	 * access handle
1276 	 */
1277 	return (&((ddi_acc_impl_t *)hdl)->ahi_common);
1278 }
1279 
1280 ddi_acc_handle_t
1281 impl_acc_hdl_alloc(int (*waitfp)(caddr_t), caddr_t arg)
1282 {
1283 	ddi_acc_impl_t *hp;
1284 	on_trap_data_t *otp;
1285 	int sleepflag;
1286 
1287 	sleepflag = ((waitfp == (int (*)())KM_SLEEP) ? KM_SLEEP : KM_NOSLEEP);
1288 
1289 	/*
1290 	 * Allocate and initialize the data access handle and error status.
1291 	 */
1292 	if ((hp = kmem_zalloc(sizeof (ddi_acc_impl_t), sleepflag)) == NULL)
1293 		goto fail;
1294 	if ((hp->ahi_err = (ndi_err_t *)kmem_zalloc(
1295 	    sizeof (ndi_err_t), sleepflag)) == NULL) {
1296 		kmem_free(hp, sizeof (ddi_acc_impl_t));
1297 		goto fail;
1298 	}
1299 	if ((otp = (on_trap_data_t *)kmem_zalloc(
1300 	    sizeof (on_trap_data_t), sleepflag)) == NULL) {
1301 		kmem_free(hp->ahi_err, sizeof (ndi_err_t));
1302 		kmem_free(hp, sizeof (ddi_acc_impl_t));
1303 		goto fail;
1304 	}
1305 	hp->ahi_err->err_ontrap = otp;
1306 	hp->ahi_common.ah_platform_private = (void *)hp;
1307 
1308 	return ((ddi_acc_handle_t)hp);
1309 fail:
1310 	if ((waitfp != (int (*)())KM_SLEEP) &&
1311 	    (waitfp != (int (*)())KM_NOSLEEP))
1312 		ddi_set_callback(waitfp, arg, &impl_acc_hdl_id);
1313 	return (NULL);
1314 }
1315 
1316 void
1317 impl_acc_hdl_free(ddi_acc_handle_t handle)
1318 {
1319 	ddi_acc_impl_t *hp;
1320 
1321 	/*
1322 	 * The supplied (ddi_acc_handle_t) is actually a (ddi_acc_impl_t *),
1323 	 * because that's what we allocated in impl_acc_hdl_alloc() above.
1324 	 */
1325 	hp = (ddi_acc_impl_t *)handle;
1326 	if (hp) {
1327 		kmem_free(hp->ahi_err->err_ontrap, sizeof (on_trap_data_t));
1328 		kmem_free(hp->ahi_err, sizeof (ndi_err_t));
1329 		kmem_free(hp, sizeof (ddi_acc_impl_t));
1330 		if (impl_acc_hdl_id)
1331 			ddi_run_callback(&impl_acc_hdl_id);
1332 	}
1333 }
1334 
1335 #define	PCI_GET_MP_PFN(mp, page_no)	((mp)->dmai_ndvmapages == 1 ? \
1336 	(pfn_t)(mp)->dmai_iopte:(((pfn_t *)(mp)->dmai_iopte)[page_no]))
1337 
1338 /*
1339  * Function called after a dma fault occurred to find out whether the
1340  * fault address is associated with a driver that is able to handle faults
1341  * and recover from faults.
1342  */
1343 /* ARGSUSED */
1344 int
1345 impl_dma_check(dev_info_t *dip, const void *handle, const void *addr,
1346     const void *not_used)
1347 {
1348 	ddi_dma_impl_t *mp = (ddi_dma_impl_t *)handle;
1349 	pfn_t fault_pfn = mmu_btop(*(uint64_t *)addr);
1350 	pfn_t comp_pfn;
1351 
1352 	/*
1353 	 * The driver has to set DDI_DMA_FLAGERR to recover from dma faults.
1354 	 */
1355 	int page;
1356 
1357 	ASSERT(mp);
1358 	for (page = 0; page < mp->dmai_ndvmapages; page++) {
1359 		comp_pfn = PCI_GET_MP_PFN(mp, page);
1360 		if (fault_pfn == comp_pfn)
1361 			return (DDI_FM_NONFATAL);
1362 	}
1363 	return (DDI_FM_UNKNOWN);
1364 }
1365 
1366 /*
1367  * Function used to check if a given access handle owns the failing address.
1368  * Called by ndi_fmc_error, when we detect a PIO error.
1369  */
1370 /* ARGSUSED */
1371 static int
1372 impl_acc_check(dev_info_t *dip, const void *handle, const void *addr,
1373     const void *not_used)
1374 {
1375 	pfn_t pfn, fault_pfn;
1376 	ddi_acc_hdl_t *hp;
1377 
1378 	hp = impl_acc_hdl_get((ddi_acc_handle_t)handle);
1379 
1380 	ASSERT(hp);
1381 
1382 	if (addr != NULL) {
1383 		pfn = hp->ah_pfn;
1384 		fault_pfn = mmu_btop(*(uint64_t *)addr);
1385 		if (fault_pfn >= pfn && fault_pfn < (pfn + hp->ah_pnum))
1386 			return (DDI_FM_NONFATAL);
1387 	}
1388 	return (DDI_FM_UNKNOWN);
1389 }
1390 
1391 void
1392 impl_acc_err_init(ddi_acc_hdl_t *handlep)
1393 {
1394 	int fmcap;
1395 	ndi_err_t *errp;
1396 	on_trap_data_t *otp;
1397 	ddi_acc_impl_t *hp = (ddi_acc_impl_t *)handlep;
1398 
1399 	fmcap = ddi_fm_capable(handlep->ah_dip);
1400 
1401 	if (handlep->ah_acc.devacc_attr_version < DDI_DEVICE_ATTR_V1 ||
1402 	    !DDI_FM_ACC_ERR_CAP(fmcap)) {
1403 		handlep->ah_acc.devacc_attr_access = DDI_DEFAULT_ACC;
1404 	} else if (DDI_FM_ACC_ERR_CAP(fmcap)) {
1405 		if (handlep->ah_acc.devacc_attr_access == DDI_DEFAULT_ACC) {
1406 			if (handlep->ah_xfermodes)
1407 				return;
1408 			i_ddi_drv_ereport_post(handlep->ah_dip, DVR_EFMCAP,
1409 			    NULL, DDI_NOSLEEP);
1410 		} else {
1411 			errp = hp->ahi_err;
1412 			otp = (on_trap_data_t *)errp->err_ontrap;
1413 			otp->ot_handle = (void *)(hp);
1414 			otp->ot_prot = OT_DATA_ACCESS;
1415 			if (handlep->ah_acc.devacc_attr_access ==
1416 			    DDI_CAUTIOUS_ACC)
1417 				otp->ot_trampoline =
1418 				    (uintptr_t)&i_ddi_caut_trampoline;
1419 			else
1420 				otp->ot_trampoline =
1421 				    (uintptr_t)&i_ddi_prot_trampoline;
1422 			errp->err_status = DDI_FM_OK;
1423 			errp->err_expected = DDI_FM_ERR_UNEXPECTED;
1424 			errp->err_cf = impl_acc_check;
1425 		}
1426 	}
1427 }
1428 
1429 void
1430 impl_acc_hdl_init(ddi_acc_hdl_t *handlep)
1431 {
1432 	ddi_acc_impl_t *hp;
1433 
1434 	ASSERT(handlep);
1435 
1436 	hp = (ddi_acc_impl_t *)handlep;
1437 
1438 	/*
1439 	 * check for SW byte-swapping
1440 	 */
1441 	hp->ahi_get8 = i_ddi_get8;
1442 	hp->ahi_put8 = i_ddi_put8;
1443 	hp->ahi_rep_get8 = i_ddi_rep_get8;
1444 	hp->ahi_rep_put8 = i_ddi_rep_put8;
1445 	if (handlep->ah_acc.devacc_attr_endian_flags & DDI_STRUCTURE_LE_ACC) {
1446 		hp->ahi_get16 = i_ddi_swap_get16;
1447 		hp->ahi_get32 = i_ddi_swap_get32;
1448 		hp->ahi_get64 = i_ddi_swap_get64;
1449 		hp->ahi_put16 = i_ddi_swap_put16;
1450 		hp->ahi_put32 = i_ddi_swap_put32;
1451 		hp->ahi_put64 = i_ddi_swap_put64;
1452 		hp->ahi_rep_get16 = i_ddi_swap_rep_get16;
1453 		hp->ahi_rep_get32 = i_ddi_swap_rep_get32;
1454 		hp->ahi_rep_get64 = i_ddi_swap_rep_get64;
1455 		hp->ahi_rep_put16 = i_ddi_swap_rep_put16;
1456 		hp->ahi_rep_put32 = i_ddi_swap_rep_put32;
1457 		hp->ahi_rep_put64 = i_ddi_swap_rep_put64;
1458 	} else {
1459 		hp->ahi_get16 = i_ddi_get16;
1460 		hp->ahi_get32 = i_ddi_get32;
1461 		hp->ahi_get64 = i_ddi_get64;
1462 		hp->ahi_put16 = i_ddi_put16;
1463 		hp->ahi_put32 = i_ddi_put32;
1464 		hp->ahi_put64 = i_ddi_put64;
1465 		hp->ahi_rep_get16 = i_ddi_rep_get16;
1466 		hp->ahi_rep_get32 = i_ddi_rep_get32;
1467 		hp->ahi_rep_get64 = i_ddi_rep_get64;
1468 		hp->ahi_rep_put16 = i_ddi_rep_put16;
1469 		hp->ahi_rep_put32 = i_ddi_rep_put32;
1470 		hp->ahi_rep_put64 = i_ddi_rep_put64;
1471 	}
1472 
1473 	/* Legacy fault flags and support */
1474 	hp->ahi_fault_check = i_ddi_acc_fault_check;
1475 	hp->ahi_fault_notify = i_ddi_acc_fault_notify;
1476 	hp->ahi_fault = 0;
1477 	impl_acc_err_init(handlep);
1478 }
1479 
1480 void
1481 i_ddi_acc_set_fault(ddi_acc_handle_t handle)
1482 {
1483 	ddi_acc_impl_t *hp = (ddi_acc_impl_t *)handle;
1484 
1485 	if (!hp->ahi_fault) {
1486 		hp->ahi_fault = 1;
1487 			(*hp->ahi_fault_notify)(hp);
1488 	}
1489 }
1490 
1491 void
1492 i_ddi_acc_clr_fault(ddi_acc_handle_t handle)
1493 {
1494 	ddi_acc_impl_t *hp = (ddi_acc_impl_t *)handle;
1495 
1496 	if (hp->ahi_fault) {
1497 		hp->ahi_fault = 0;
1498 			(*hp->ahi_fault_notify)(hp);
1499 	}
1500 }
1501 
1502 /* ARGSUSED */
1503 void
1504 i_ddi_acc_fault_notify(ddi_acc_impl_t *hp)
1505 {
1506 	/* Default version, does nothing */
1507 }
1508 
1509 /*
1510  * SECTION: Misc functions
1511  */
1512 
1513 /*
1514  * instance wrappers
1515  */
1516 /*ARGSUSED*/
1517 uint_t
1518 impl_assign_instance(dev_info_t *dip)
1519 {
1520 	return ((uint_t)-1);
1521 }
1522 
1523 /*ARGSUSED*/
1524 int
1525 impl_keep_instance(dev_info_t *dip)
1526 {
1527 	return (DDI_FAILURE);
1528 }
1529 
1530 /*ARGSUSED*/
1531 int
1532 impl_free_instance(dev_info_t *dip)
1533 {
1534 	return (DDI_FAILURE);
1535 }
1536 
1537 /*ARGSUSED*/
1538 int
1539 impl_check_cpu(dev_info_t *devi)
1540 {
1541 	return (DDI_SUCCESS);
1542 }
1543 
1544 
1545 static const char *nocopydevs[] = {
1546 	"SUNW,ffb",
1547 	"SUNW,afb",
1548 	NULL
1549 };
1550 
1551 /*
1552  * Perform a copy from a memory mapped device (whose devinfo pointer is devi)
1553  * separately mapped at devaddr in the kernel to a kernel buffer at kaddr.
1554  */
1555 /*ARGSUSED*/
1556 int
1557 e_ddi_copyfromdev(dev_info_t *devi,
1558     off_t off, const void *devaddr, void *kaddr, size_t len)
1559 {
1560 	const char **argv;
1561 
1562 	for (argv = nocopydevs; *argv; argv++)
1563 		if (strcmp(ddi_binding_name(devi), *argv) == 0) {
1564 			bzero(kaddr, len);
1565 			return (0);
1566 		}
1567 
1568 	bcopy(devaddr, kaddr, len);
1569 	return (0);
1570 }
1571 
1572 /*
1573  * Perform a copy to a memory mapped device (whose devinfo pointer is devi)
1574  * separately mapped at devaddr in the kernel from a kernel buffer at kaddr.
1575  */
1576 /*ARGSUSED*/
1577 int
1578 e_ddi_copytodev(dev_info_t *devi,
1579     off_t off, const void *kaddr, void *devaddr, size_t len)
1580 {
1581 	const char **argv;
1582 
1583 	for (argv = nocopydevs; *argv; argv++)
1584 		if (strcmp(ddi_binding_name(devi), *argv) == 0)
1585 			return (1);
1586 
1587 	bcopy(kaddr, devaddr, len);
1588 	return (0);
1589 }
1590 
1591 /*
1592  * Boot Configuration
1593  */
1594 idprom_t idprom;
1595 
1596 /*
1597  * Configure the hardware on the system.
1598  * Called before the rootfs is mounted
1599  */
1600 void
1601 configure(void)
1602 {
1603 	extern void i_ddi_init_root();
1604 
1605 	/* We better have released boot by this time! */
1606 	ASSERT(!bootops);
1607 
1608 	/*
1609 	 * Determine whether or not to use the fpu, V9 SPARC cpus
1610 	 * always have one. Could check for existence of a fp queue,
1611 	 * Ultra I, II and IIa do not have a fp queue.
1612 	 */
1613 	if (fpu_exists)
1614 		fpu_probe();
1615 	else
1616 		cmn_err(CE_CONT, "FPU not in use\n");
1617 
1618 #if 0 /* XXXQ - not necessary for sun4u */
1619 	/*
1620 	 * This following line fixes bugid 1041296; we need to do a
1621 	 * prom_nextnode(0) because this call ALSO patches the DMA+
1622 	 * bug in Campus-B and Phoenix. The prom uncaches the traptable
1623 	 * page as a side-effect of devr_next(0) (which prom_nextnode calls),
1624 	 * so this *must* be executed early on. (XXX This is untrue for sun4u)
1625 	 */
1626 	(void) prom_nextnode((pnode_t)0);
1627 #endif
1628 
1629 	/*
1630 	 * Initialize devices on the machine.
1631 	 * Uses configuration tree built by the PROMs to determine what
1632 	 * is present, and builds a tree of prototype dev_info nodes
1633 	 * corresponding to the hardware which identified itself.
1634 	 */
1635 	i_ddi_init_root();
1636 
1637 #ifdef	DDI_PROP_DEBUG
1638 	(void) ddi_prop_debug(1);	/* Enable property debugging */
1639 #endif	/* DDI_PROP_DEBUG */
1640 }
1641 
1642 /*
1643  * The "status" property indicates the operational status of a device.
1644  * If this property is present, the value is a string indicating the
1645  * status of the device as follows:
1646  *
1647  *	"okay"		operational.
1648  *	"disabled"	not operational, but might become operational.
1649  *	"fail"		not operational because a fault has been detected,
1650  *			and it is unlikely that the device will become
1651  *			operational without repair. no additional details
1652  *			are available.
1653  *	"fail-xxx"	not operational because a fault has been detected,
1654  *			and it is unlikely that the device will become
1655  *			operational without repair. "xxx" is additional
1656  *			human-readable information about the particular
1657  *			fault condition that was detected.
1658  *
1659  * The absence of this property means that the operational status is
1660  * unknown or okay.
1661  *
1662  * This routine checks the status property of the specified device node
1663  * and returns 0 if the operational status indicates failure, and 1 otherwise.
1664  *
1665  * The property may exist on plug-in cards the existed before IEEE 1275-1994.
1666  * And, in that case, the property may not even be a string. So we carefully
1667  * check for the value "fail", in the beginning of the string, noting
1668  * the property length.
1669  */
1670 int
1671 status_okay(int id, char *buf, int buflen)
1672 {
1673 	char status_buf[OBP_MAXPROPNAME];
1674 	char *bufp = buf;
1675 	int len = buflen;
1676 	int proplen;
1677 	static const char *status = "status";
1678 	static const char *fail = "fail";
1679 	size_t fail_len = strlen(fail);
1680 
1681 	/*
1682 	 * Get the proplen ... if it's smaller than "fail",
1683 	 * or doesn't exist ... then we don't care, since
1684 	 * the value can't begin with the char string "fail".
1685 	 *
1686 	 * NB: proplen, if it's a string, includes the NULL in the
1687 	 * the size of the property, and fail_len does not.
1688 	 */
1689 	proplen = prom_getproplen((pnode_t)id, (caddr_t)status);
1690 	if (proplen <= fail_len)	/* nonexistent or uninteresting len */
1691 		return (1);
1692 
1693 	/*
1694 	 * if a buffer was provided, use it
1695 	 */
1696 	if ((buf == (char *)NULL) || (buflen <= 0)) {
1697 		bufp = status_buf;
1698 		len = sizeof (status_buf);
1699 	}
1700 	*bufp = (char)0;
1701 
1702 	/*
1703 	 * Get the property into the buffer, to the extent of the buffer,
1704 	 * and in case the buffer is smaller than the property size,
1705 	 * NULL terminate the buffer. (This handles the case where
1706 	 * a buffer was passed in and the caller wants to print the
1707 	 * value, but the buffer was too small).
1708 	 */
1709 	(void) prom_bounded_getprop((pnode_t)id, (caddr_t)status,
1710 	    (caddr_t)bufp, len);
1711 	*(bufp + len - 1) = (char)0;
1712 
1713 	/*
1714 	 * If the value begins with the char string "fail",
1715 	 * then it means the node is failed. We don't care
1716 	 * about any other values. We assume the node is ok
1717 	 * although it might be 'disabled'.
1718 	 */
1719 	if (strncmp(bufp, fail, fail_len) == 0)
1720 		return (0);
1721 
1722 	return (1);
1723 }
1724 
1725 
1726 /*
1727  * We set the cpu type from the idprom, if we can.
1728  * Note that we just read out the contents of it, for the most part.
1729  */
1730 void
1731 setcputype(void)
1732 {
1733 	/*
1734 	 * We cache the idprom info early on so that we don't
1735 	 * rummage through the NVRAM unnecessarily later.
1736 	 */
1737 	(void) prom_getidprom((caddr_t)&idprom, sizeof (idprom));
1738 }
1739 
1740 /*
1741  *  Here is where we actually infer meanings to the members of idprom_t
1742  */
1743 void
1744 parse_idprom(void)
1745 {
1746 	if (idprom.id_format == IDFORM_1) {
1747 		(void) localetheraddr((struct ether_addr *)idprom.id_ether,
1748 		    (struct ether_addr *)NULL);
1749 		(void) snprintf(hw_serial, HW_HOSTID_LEN, "%u",
1750 		    (idprom.id_machine << 24) + idprom.id_serial);
1751 	} else
1752 		prom_printf("Invalid format code in IDprom.\n");
1753 }
1754 
1755 /*
1756  * Allow for implementation specific correction of PROM property values.
1757  */
1758 /*ARGSUSED*/
1759 void
1760 impl_fix_props(dev_info_t *dip, dev_info_t *ch_dip, char *name, int len,
1761     caddr_t buffer)
1762 {
1763 	/*
1764 	 * There are no adjustments needed in this implementation.
1765 	 */
1766 }
1767 
1768 /*
1769  * The following functions ready a cautious request to go up to the nexus
1770  * driver.  It is up to the nexus driver to decide how to process the request.
1771  * It may choose to call i_ddi_do_caut_get/put in this file, or do it
1772  * differently.
1773  */
1774 
1775 static void
1776 i_ddi_caut_getput_ctlops(
1777     ddi_acc_impl_t *hp, uint64_t host_addr, uint64_t dev_addr, size_t size,
1778     size_t repcount, uint_t flags, ddi_ctl_enum_t cmd)
1779 {
1780 	peekpoke_ctlops_t	cautacc_ctlops_arg;
1781 
1782 	cautacc_ctlops_arg.size = size;
1783 	cautacc_ctlops_arg.dev_addr = dev_addr;
1784 	cautacc_ctlops_arg.host_addr = host_addr;
1785 	cautacc_ctlops_arg.handle = (ddi_acc_handle_t)hp;
1786 	cautacc_ctlops_arg.repcount = repcount;
1787 	cautacc_ctlops_arg.flags = flags;
1788 
1789 	(void) ddi_ctlops(hp->ahi_common.ah_dip, hp->ahi_common.ah_dip, cmd,
1790 	    &cautacc_ctlops_arg, NULL);
1791 }
1792 
1793 uint8_t
1794 i_ddi_caut_get8(ddi_acc_impl_t *hp, uint8_t *addr)
1795 {
1796 	uint8_t value;
1797 	i_ddi_caut_getput_ctlops(hp, (uint64_t)&value, (uint64_t)addr,
1798 	    sizeof (uint8_t), 1, 0, DDI_CTLOPS_PEEK);
1799 
1800 	return (value);
1801 }
1802 
1803 uint16_t
1804 i_ddi_caut_get16(ddi_acc_impl_t *hp, uint16_t *addr)
1805 {
1806 	uint16_t value;
1807 	i_ddi_caut_getput_ctlops(hp, (uint64_t)&value, (uint64_t)addr,
1808 	    sizeof (uint16_t), 1, 0, DDI_CTLOPS_PEEK);
1809 
1810 	return (value);
1811 }
1812 
1813 uint32_t
1814 i_ddi_caut_get32(ddi_acc_impl_t *hp, uint32_t *addr)
1815 {
1816 	uint32_t value;
1817 	i_ddi_caut_getput_ctlops(hp, (uint64_t)&value, (uint64_t)addr,
1818 	    sizeof (uint32_t), 1, 0, DDI_CTLOPS_PEEK);
1819 
1820 	return (value);
1821 }
1822 
1823 uint64_t
1824 i_ddi_caut_get64(ddi_acc_impl_t *hp, uint64_t *addr)
1825 {
1826 	uint64_t value;
1827 	i_ddi_caut_getput_ctlops(hp, (uint64_t)&value, (uint64_t)addr,
1828 	    sizeof (uint64_t), 1, 0, DDI_CTLOPS_PEEK);
1829 
1830 	return (value);
1831 }
1832 
1833 void
1834 i_ddi_caut_put8(ddi_acc_impl_t *hp, uint8_t *addr, uint8_t value)
1835 {
1836 	i_ddi_caut_getput_ctlops(hp, (uint64_t)&value, (uint64_t)addr,
1837 	    sizeof (uint8_t), 1, 0, DDI_CTLOPS_POKE);
1838 }
1839 
1840 void
1841 i_ddi_caut_put16(ddi_acc_impl_t *hp, uint16_t *addr, uint16_t value)
1842 {
1843 	i_ddi_caut_getput_ctlops(hp, (uint64_t)&value, (uint64_t)addr,
1844 	    sizeof (uint16_t), 1, 0, DDI_CTLOPS_POKE);
1845 }
1846 
1847 void
1848 i_ddi_caut_put32(ddi_acc_impl_t *hp, uint32_t *addr, uint32_t value)
1849 {
1850 	i_ddi_caut_getput_ctlops(hp, (uint64_t)&value, (uint64_t)addr,
1851 	    sizeof (uint32_t), 1, 0, DDI_CTLOPS_POKE);
1852 }
1853 
1854 void
1855 i_ddi_caut_put64(ddi_acc_impl_t *hp, uint64_t *addr, uint64_t value)
1856 {
1857 	i_ddi_caut_getput_ctlops(hp, (uint64_t)&value, (uint64_t)addr,
1858 	    sizeof (uint64_t), 1, 0, DDI_CTLOPS_POKE);
1859 }
1860 
1861 void
1862 i_ddi_caut_rep_get8(ddi_acc_impl_t *hp, uint8_t *host_addr, uint8_t *dev_addr,
1863 	size_t repcount, uint_t flags)
1864 {
1865 	i_ddi_caut_getput_ctlops(hp, (uint64_t)host_addr, (uint64_t)dev_addr,
1866 	    sizeof (uint8_t), repcount, flags, DDI_CTLOPS_PEEK);
1867 }
1868 
1869 void
1870 i_ddi_caut_rep_get16(ddi_acc_impl_t *hp, uint16_t *host_addr,
1871     uint16_t *dev_addr, size_t repcount, uint_t flags)
1872 {
1873 	i_ddi_caut_getput_ctlops(hp, (uint64_t)host_addr, (uint64_t)dev_addr,
1874 	    sizeof (uint16_t), repcount, flags, DDI_CTLOPS_PEEK);
1875 }
1876 
1877 void
1878 i_ddi_caut_rep_get32(ddi_acc_impl_t *hp, uint32_t *host_addr,
1879     uint32_t *dev_addr, size_t repcount, uint_t flags)
1880 {
1881 	i_ddi_caut_getput_ctlops(hp, (uint64_t)host_addr, (uint64_t)dev_addr,
1882 	    sizeof (uint32_t), repcount, flags, DDI_CTLOPS_PEEK);
1883 }
1884 
1885 void
1886 i_ddi_caut_rep_get64(ddi_acc_impl_t *hp, uint64_t *host_addr,
1887     uint64_t *dev_addr, size_t repcount, uint_t flags)
1888 {
1889 	i_ddi_caut_getput_ctlops(hp, (uint64_t)host_addr, (uint64_t)dev_addr,
1890 	    sizeof (uint64_t), repcount, flags, DDI_CTLOPS_PEEK);
1891 }
1892 
1893 void
1894 i_ddi_caut_rep_put8(ddi_acc_impl_t *hp, uint8_t *host_addr, uint8_t *dev_addr,
1895 	size_t repcount, uint_t flags)
1896 {
1897 	i_ddi_caut_getput_ctlops(hp, (uint64_t)host_addr, (uint64_t)dev_addr,
1898 	    sizeof (uint8_t), repcount, flags, DDI_CTLOPS_POKE);
1899 }
1900 
1901 void
1902 i_ddi_caut_rep_put16(ddi_acc_impl_t *hp, uint16_t *host_addr,
1903     uint16_t *dev_addr, size_t repcount, uint_t flags)
1904 {
1905 	i_ddi_caut_getput_ctlops(hp, (uint64_t)host_addr, (uint64_t)dev_addr,
1906 	    sizeof (uint16_t), repcount, flags, DDI_CTLOPS_POKE);
1907 }
1908 
1909 void
1910 i_ddi_caut_rep_put32(ddi_acc_impl_t *hp, uint32_t *host_addr,
1911     uint32_t *dev_addr, size_t repcount, uint_t flags)
1912 {
1913 	i_ddi_caut_getput_ctlops(hp, (uint64_t)host_addr, (uint64_t)dev_addr,
1914 	    sizeof (uint32_t), repcount, flags, DDI_CTLOPS_POKE);
1915 }
1916 
1917 void
1918 i_ddi_caut_rep_put64(ddi_acc_impl_t *hp, uint64_t *host_addr,
1919     uint64_t *dev_addr, size_t repcount, uint_t flags)
1920 {
1921 	i_ddi_caut_getput_ctlops(hp, (uint64_t)host_addr, (uint64_t)dev_addr,
1922 	    sizeof (uint64_t), repcount, flags, DDI_CTLOPS_POKE);
1923 }
1924 
1925 /*
1926  * This is called only to process peek/poke when the DIP is NULL.
1927  * Assume that this is for memory, as nexi take care of device safe accesses.
1928  */
1929 int
1930 peekpoke_mem(ddi_ctl_enum_t cmd, peekpoke_ctlops_t *in_args)
1931 {
1932 	int err = DDI_SUCCESS;
1933 	on_trap_data_t otd;
1934 
1935 	/* Set up protected environment. */
1936 	if (!on_trap(&otd, OT_DATA_ACCESS)) {
1937 		uintptr_t tramp = otd.ot_trampoline;
1938 
1939 		if (cmd == DDI_CTLOPS_POKE) {
1940 			otd.ot_trampoline = (uintptr_t)&poke_fault;
1941 			err = do_poke(in_args->size, (void *)in_args->dev_addr,
1942 			    (void *)in_args->host_addr);
1943 		} else {
1944 			otd.ot_trampoline = (uintptr_t)&peek_fault;
1945 			err = do_peek(in_args->size, (void *)in_args->dev_addr,
1946 			    (void *)in_args->host_addr);
1947 		}
1948 		otd.ot_trampoline = tramp;
1949 	} else
1950 		err = DDI_FAILURE;
1951 
1952 	/* Take down protected environment. */
1953 	no_trap();
1954 
1955 	return (err);
1956 }
1957 
1958 /*
1959  * Platform independent DR routines
1960  */
1961 
1962 static int
1963 ndi2errno(int n)
1964 {
1965 	int err = 0;
1966 
1967 	switch (n) {
1968 		case NDI_NOMEM:
1969 			err = ENOMEM;
1970 			break;
1971 		case NDI_BUSY:
1972 			err = EBUSY;
1973 			break;
1974 		case NDI_FAULT:
1975 			err = EFAULT;
1976 			break;
1977 		case NDI_FAILURE:
1978 			err = EIO;
1979 			break;
1980 		case NDI_SUCCESS:
1981 			break;
1982 		case NDI_BADHANDLE:
1983 		default:
1984 			err = EINVAL;
1985 			break;
1986 	}
1987 	return (err);
1988 }
1989 
1990 /*
1991  * Prom tree node list
1992  */
1993 struct ptnode {
1994 	pnode_t		nodeid;
1995 	struct ptnode	*next;
1996 };
1997 
1998 /*
1999  * Prom tree walk arg
2000  */
2001 struct pta {
2002 	dev_info_t	*pdip;
2003 	devi_branch_t	*bp;
2004 	uint_t		flags;
2005 	dev_info_t	*fdip;
2006 	struct ptnode	*head;
2007 };
2008 
2009 static void
2010 visit_node(pnode_t nodeid, struct pta *ap)
2011 {
2012 	struct ptnode	**nextp;
2013 	int		(*select)(pnode_t, void *, uint_t);
2014 
2015 	ASSERT(nodeid != OBP_NONODE && nodeid != OBP_BADNODE);
2016 
2017 	select = ap->bp->create.prom_branch_select;
2018 
2019 	ASSERT(select);
2020 
2021 	if (select(nodeid, ap->bp->arg, 0) == DDI_SUCCESS) {
2022 
2023 		for (nextp = &ap->head; *nextp; nextp = &(*nextp)->next)
2024 			;
2025 
2026 		*nextp = kmem_zalloc(sizeof (struct ptnode), KM_SLEEP);
2027 
2028 		(*nextp)->nodeid = nodeid;
2029 	}
2030 
2031 	if ((ap->flags & DEVI_BRANCH_CHILD) == DEVI_BRANCH_CHILD)
2032 		return;
2033 
2034 	nodeid = prom_childnode(nodeid);
2035 	while (nodeid != OBP_NONODE && nodeid != OBP_BADNODE) {
2036 		visit_node(nodeid, ap);
2037 		nodeid = prom_nextnode(nodeid);
2038 	}
2039 }
2040 
2041 /*
2042  * NOTE: The caller of this function must check for device contracts
2043  * or LDI callbacks against this dip before setting the dip offline.
2044  */
2045 static int
2046 set_infant_dip_offline(dev_info_t *dip, void *arg)
2047 {
2048 	char	*path = (char *)arg;
2049 
2050 	ASSERT(dip);
2051 	ASSERT(arg);
2052 
2053 	if (i_ddi_node_state(dip) >= DS_ATTACHED) {
2054 		(void) ddi_pathname(dip, path);
2055 		cmn_err(CE_WARN, "Attempt to set offline flag on attached "
2056 		    "node: %s", path);
2057 		return (DDI_FAILURE);
2058 	}
2059 
2060 	mutex_enter(&(DEVI(dip)->devi_lock));
2061 	if (!DEVI_IS_DEVICE_OFFLINE(dip))
2062 		DEVI_SET_DEVICE_OFFLINE(dip);
2063 	mutex_exit(&(DEVI(dip)->devi_lock));
2064 
2065 	return (DDI_SUCCESS);
2066 }
2067 
2068 typedef struct result {
2069 	char	*path;
2070 	int	result;
2071 } result_t;
2072 
2073 static int
2074 dip_set_offline(dev_info_t *dip, void *arg)
2075 {
2076 	int end;
2077 	result_t *resp = (result_t *)arg;
2078 
2079 	ASSERT(dip);
2080 	ASSERT(resp);
2081 
2082 	/*
2083 	 * We stop the walk if e_ddi_offline_notify() returns
2084 	 * failure, because this implies that one or more consumers
2085 	 * (either LDI or contract based) has blocked the offline.
2086 	 * So there is no point in conitnuing the walk
2087 	 */
2088 	if (e_ddi_offline_notify(dip) == DDI_FAILURE) {
2089 		resp->result = DDI_FAILURE;
2090 		return (DDI_WALK_TERMINATE);
2091 	}
2092 
2093 	/*
2094 	 * If set_infant_dip_offline() returns failure, it implies
2095 	 * that we failed to set a particular dip offline. This
2096 	 * does not imply that the offline as a whole should fail.
2097 	 * We want to do the best we can, so we continue the walk.
2098 	 */
2099 	if (set_infant_dip_offline(dip, resp->path) == DDI_SUCCESS)
2100 		end = DDI_SUCCESS;
2101 	else
2102 		end = DDI_FAILURE;
2103 
2104 	e_ddi_offline_finalize(dip, end);
2105 
2106 	return (DDI_WALK_CONTINUE);
2107 }
2108 
2109 /*
2110  * The call to e_ddi_offline_notify() exists for the
2111  * unlikely error case that a branch we are trying to
2112  * create already exists and has device contracts or LDI
2113  * event callbacks against it.
2114  *
2115  * We allow create to succeed for such branches only if
2116  * no constraints block the offline.
2117  */
2118 static int
2119 branch_set_offline(dev_info_t *dip, char *path)
2120 {
2121 	int		circ;
2122 	int		end;
2123 	result_t	res;
2124 
2125 
2126 	if (e_ddi_offline_notify(dip) == DDI_FAILURE) {
2127 		return (DDI_FAILURE);
2128 	}
2129 
2130 	if (set_infant_dip_offline(dip, path) == DDI_SUCCESS)
2131 		end = DDI_SUCCESS;
2132 	else
2133 		end = DDI_FAILURE;
2134 
2135 	e_ddi_offline_finalize(dip, end);
2136 
2137 	if (end == DDI_FAILURE)
2138 		return (DDI_FAILURE);
2139 
2140 	res.result = DDI_SUCCESS;
2141 	res.path = path;
2142 
2143 	ndi_devi_enter(dip, &circ);
2144 	ddi_walk_devs(ddi_get_child(dip), dip_set_offline, &res);
2145 	ndi_devi_exit(dip, circ);
2146 
2147 	return (res.result);
2148 }
2149 
2150 /*ARGSUSED*/
2151 static int
2152 create_prom_branch(void *arg, int has_changed)
2153 {
2154 	int		circ;
2155 	int		exists, rv;
2156 	pnode_t		nodeid;
2157 	struct ptnode	*tnp;
2158 	dev_info_t	*dip;
2159 	struct pta	*ap = arg;
2160 	devi_branch_t	*bp;
2161 	char		*path;
2162 
2163 	ASSERT(ap);
2164 	ASSERT(ap->fdip == NULL);
2165 	ASSERT(ap->pdip && ndi_dev_is_prom_node(ap->pdip));
2166 
2167 	bp = ap->bp;
2168 
2169 	nodeid = ddi_get_nodeid(ap->pdip);
2170 	if (nodeid == OBP_NONODE || nodeid == OBP_BADNODE) {
2171 		cmn_err(CE_WARN, "create_prom_branch: invalid "
2172 		    "nodeid: 0x%x", nodeid);
2173 		return (EINVAL);
2174 	}
2175 
2176 	ap->head = NULL;
2177 
2178 	nodeid = prom_childnode(nodeid);
2179 	while (nodeid != OBP_NONODE && nodeid != OBP_BADNODE) {
2180 		visit_node(nodeid, ap);
2181 		nodeid = prom_nextnode(nodeid);
2182 	}
2183 
2184 	if (ap->head == NULL)
2185 		return (ENODEV);
2186 
2187 	path = kmem_alloc(MAXPATHLEN, KM_SLEEP);
2188 	rv = 0;
2189 	while ((tnp = ap->head) != NULL) {
2190 		ap->head = tnp->next;
2191 
2192 		ndi_devi_enter(ap->pdip, &circ);
2193 
2194 		/*
2195 		 * Check if the branch already exists.
2196 		 */
2197 		exists = 0;
2198 		dip = e_ddi_nodeid_to_dip(tnp->nodeid);
2199 		if (dip != NULL) {
2200 			exists = 1;
2201 
2202 			/* Parent is held busy, so release hold */
2203 			ndi_rele_devi(dip);
2204 #ifdef	DEBUG
2205 			cmn_err(CE_WARN, "create_prom_branch: dip(%p) exists"
2206 			    " for nodeid 0x%x", (void *)dip, tnp->nodeid);
2207 #endif
2208 		} else {
2209 			dip = i_ddi_create_branch(ap->pdip, tnp->nodeid);
2210 		}
2211 
2212 		kmem_free(tnp, sizeof (struct ptnode));
2213 
2214 		/*
2215 		 * Hold the branch if it is not already held
2216 		 */
2217 		if (dip && !exists) {
2218 			e_ddi_branch_hold(dip);
2219 		}
2220 
2221 		ASSERT(dip == NULL || e_ddi_branch_held(dip));
2222 
2223 		/*
2224 		 * Set all dips in the newly created branch offline so that
2225 		 * only a "configure" operation can attach
2226 		 * the branch
2227 		 */
2228 		if (dip == NULL || branch_set_offline(dip, path)
2229 		    == DDI_FAILURE) {
2230 			ndi_devi_exit(ap->pdip, circ);
2231 			rv = EIO;
2232 			continue;
2233 		}
2234 
2235 		ASSERT(ddi_get_parent(dip) == ap->pdip);
2236 
2237 		ndi_devi_exit(ap->pdip, circ);
2238 
2239 		if (ap->flags & DEVI_BRANCH_CONFIGURE) {
2240 			int error = e_ddi_branch_configure(dip, &ap->fdip, 0);
2241 			if (error && rv == 0)
2242 				rv = error;
2243 		}
2244 
2245 		/*
2246 		 * Invoke devi_branch_callback() (if it exists) only for
2247 		 * newly created branches
2248 		 */
2249 		if (bp->devi_branch_callback && !exists)
2250 			bp->devi_branch_callback(dip, bp->arg, 0);
2251 	}
2252 
2253 	kmem_free(path, MAXPATHLEN);
2254 
2255 	return (rv);
2256 }
2257 
2258 static int
2259 sid_node_create(dev_info_t *pdip, devi_branch_t *bp, dev_info_t **rdipp)
2260 {
2261 	int			rv, circ, len;
2262 	int			i, flags, ret;
2263 	dev_info_t		*dip;
2264 	char			*nbuf;
2265 	char			*path;
2266 	static const char	*noname = "<none>";
2267 
2268 	ASSERT(pdip);
2269 	ASSERT(DEVI_BUSY_OWNED(pdip));
2270 
2271 	flags = 0;
2272 
2273 	/*
2274 	 * Creating the root of a branch ?
2275 	 */
2276 	if (rdipp) {
2277 		*rdipp = NULL;
2278 		flags = DEVI_BRANCH_ROOT;
2279 	}
2280 
2281 	ndi_devi_alloc_sleep(pdip, (char *)noname, DEVI_SID_NODEID, &dip);
2282 	rv = bp->create.sid_branch_create(dip, bp->arg, flags);
2283 
2284 	nbuf = kmem_alloc(OBP_MAXDRVNAME, KM_SLEEP);
2285 
2286 	if (rv == DDI_WALK_ERROR) {
2287 		cmn_err(CE_WARN, "e_ddi_branch_create: Error setting"
2288 		    " properties on devinfo node %p",  (void *)dip);
2289 		goto fail;
2290 	}
2291 
2292 	len = OBP_MAXDRVNAME;
2293 	if (ddi_getlongprop_buf(DDI_DEV_T_ANY, dip,
2294 	    DDI_PROP_DONTPASS | DDI_PROP_NOTPROM, "name", nbuf, &len)
2295 	    != DDI_PROP_SUCCESS) {
2296 		cmn_err(CE_WARN, "e_ddi_branch_create: devinfo node %p has"
2297 		    "no name property", (void *)dip);
2298 		goto fail;
2299 	}
2300 
2301 	ASSERT(i_ddi_node_state(dip) == DS_PROTO);
2302 	if (ndi_devi_set_nodename(dip, nbuf, 0) != NDI_SUCCESS) {
2303 		cmn_err(CE_WARN, "e_ddi_branch_create: cannot set name (%s)"
2304 		    " for devinfo node %p", nbuf, (void *)dip);
2305 		goto fail;
2306 	}
2307 
2308 	kmem_free(nbuf, OBP_MAXDRVNAME);
2309 
2310 	/*
2311 	 * Ignore bind failures just like boot does
2312 	 */
2313 	(void) ndi_devi_bind_driver(dip, 0);
2314 
2315 	switch (rv) {
2316 	case DDI_WALK_CONTINUE:
2317 	case DDI_WALK_PRUNESIB:
2318 		ndi_devi_enter(dip, &circ);
2319 
2320 		i = DDI_WALK_CONTINUE;
2321 		for (; i == DDI_WALK_CONTINUE; ) {
2322 			i = sid_node_create(dip, bp, NULL);
2323 		}
2324 
2325 		ASSERT(i == DDI_WALK_ERROR || i == DDI_WALK_PRUNESIB);
2326 		if (i == DDI_WALK_ERROR)
2327 			rv = i;
2328 		/*
2329 		 * If PRUNESIB stop creating siblings
2330 		 * of dip's child. Subsequent walk behavior
2331 		 * is determined by rv returned by dip.
2332 		 */
2333 
2334 		ndi_devi_exit(dip, circ);
2335 		break;
2336 	case DDI_WALK_TERMINATE:
2337 		/*
2338 		 * Don't create children and ask our parent
2339 		 * to not create siblings either.
2340 		 */
2341 		rv = DDI_WALK_PRUNESIB;
2342 		break;
2343 	case DDI_WALK_PRUNECHILD:
2344 		/*
2345 		 * Don't create children, but ask parent to continue
2346 		 * with siblings.
2347 		 */
2348 		rv = DDI_WALK_CONTINUE;
2349 		break;
2350 	default:
2351 		ASSERT(0);
2352 		break;
2353 	}
2354 
2355 	if (rdipp)
2356 		*rdipp = dip;
2357 
2358 	/*
2359 	 * Set device offline - only the "configure" op should cause an attach.
2360 	 * Note that it is safe to set the dip offline without checking
2361 	 * for either device contract or layered driver (LDI) based constraints
2362 	 * since there cannot be any contracts or LDI opens of this device.
2363 	 * This is because this node is a newly created dip with the parent busy
2364 	 * held, so no other thread can come in and attach this dip. A dip that
2365 	 * has never been attached cannot have contracts since by definition
2366 	 * a device contract (an agreement between a process and a device minor
2367 	 * node) can only be created against a device that has minor nodes
2368 	 * i.e is attached. Similarly an LDI open will only succeed if the
2369 	 * dip is attached. We assert below that the dip is not attached.
2370 	 */
2371 	ASSERT(i_ddi_node_state(dip) < DS_ATTACHED);
2372 	path = kmem_alloc(MAXPATHLEN, KM_SLEEP);
2373 	ret = set_infant_dip_offline(dip, path);
2374 	ASSERT(ret == DDI_SUCCESS);
2375 	kmem_free(path, MAXPATHLEN);
2376 
2377 	return (rv);
2378 fail:
2379 	(void) ndi_devi_free(dip);
2380 	kmem_free(nbuf, OBP_MAXDRVNAME);
2381 	return (DDI_WALK_ERROR);
2382 }
2383 
2384 static int
2385 create_sid_branch(
2386 	dev_info_t	*pdip,
2387 	devi_branch_t	*bp,
2388 	dev_info_t	**dipp,
2389 	uint_t		flags)
2390 {
2391 	int		rv = 0, state = DDI_WALK_CONTINUE;
2392 	dev_info_t	*rdip;
2393 
2394 	while (state == DDI_WALK_CONTINUE) {
2395 		int	circ;
2396 
2397 		ndi_devi_enter(pdip, &circ);
2398 
2399 		state = sid_node_create(pdip, bp, &rdip);
2400 		if (rdip == NULL) {
2401 			ndi_devi_exit(pdip, circ);
2402 			ASSERT(state == DDI_WALK_ERROR);
2403 			break;
2404 		}
2405 
2406 		e_ddi_branch_hold(rdip);
2407 
2408 		ndi_devi_exit(pdip, circ);
2409 
2410 		if (flags & DEVI_BRANCH_CONFIGURE) {
2411 			int error = e_ddi_branch_configure(rdip, dipp, 0);
2412 			if (error && rv == 0)
2413 				rv = error;
2414 		}
2415 
2416 		/*
2417 		 * devi_branch_callback() is optional
2418 		 */
2419 		if (bp->devi_branch_callback)
2420 			bp->devi_branch_callback(rdip, bp->arg, 0);
2421 	}
2422 
2423 	ASSERT(state == DDI_WALK_ERROR || state == DDI_WALK_PRUNESIB);
2424 
2425 	return (state == DDI_WALK_ERROR ? EIO : rv);
2426 }
2427 
2428 int
2429 e_ddi_branch_create(
2430 	dev_info_t	*pdip,
2431 	devi_branch_t	*bp,
2432 	dev_info_t	**dipp,
2433 	uint_t		flags)
2434 {
2435 	int prom_devi, sid_devi, error;
2436 
2437 	if (pdip == NULL || bp == NULL || bp->type == 0)
2438 		return (EINVAL);
2439 
2440 	prom_devi = (bp->type == DEVI_BRANCH_PROM) ? 1 : 0;
2441 	sid_devi = (bp->type == DEVI_BRANCH_SID) ? 1 : 0;
2442 
2443 	if (prom_devi && bp->create.prom_branch_select == NULL)
2444 		return (EINVAL);
2445 	else if (sid_devi && bp->create.sid_branch_create == NULL)
2446 		return (EINVAL);
2447 	else if (!prom_devi && !sid_devi)
2448 		return (EINVAL);
2449 
2450 	if (flags & DEVI_BRANCH_EVENT)
2451 		return (EINVAL);
2452 
2453 	if (prom_devi) {
2454 		struct pta pta = {0};
2455 
2456 		pta.pdip = pdip;
2457 		pta.bp = bp;
2458 		pta.flags = flags;
2459 
2460 		error = prom_tree_access(create_prom_branch, &pta, NULL);
2461 
2462 		if (dipp)
2463 			*dipp = pta.fdip;
2464 		else if (pta.fdip)
2465 			ndi_rele_devi(pta.fdip);
2466 	} else {
2467 		error = create_sid_branch(pdip, bp, dipp, flags);
2468 	}
2469 
2470 	return (error);
2471 }
2472 
2473 int
2474 e_ddi_branch_configure(dev_info_t *rdip, dev_info_t **dipp, uint_t flags)
2475 {
2476 	int		rv;
2477 	char		*devnm;
2478 	dev_info_t	*pdip;
2479 
2480 	if (dipp)
2481 		*dipp = NULL;
2482 
2483 	if (rdip == NULL || flags != 0 || (flags & DEVI_BRANCH_EVENT))
2484 		return (EINVAL);
2485 
2486 	pdip = ddi_get_parent(rdip);
2487 
2488 	ndi_hold_devi(pdip);
2489 
2490 	if (!e_ddi_branch_held(rdip)) {
2491 		ndi_rele_devi(pdip);
2492 		cmn_err(CE_WARN, "e_ddi_branch_configure: "
2493 		    "dip(%p) not held", (void *)rdip);
2494 		return (EINVAL);
2495 	}
2496 
2497 	if (i_ddi_node_state(rdip) < DS_INITIALIZED) {
2498 		/*
2499 		 * First attempt to bind a driver. If we fail, return
2500 		 * success (On some platforms, dips for some device
2501 		 * types (CPUs) may not have a driver)
2502 		 */
2503 		if (ndi_devi_bind_driver(rdip, 0) != NDI_SUCCESS) {
2504 			ndi_rele_devi(pdip);
2505 			return (0);
2506 		}
2507 
2508 		if (ddi_initchild(pdip, rdip) != DDI_SUCCESS) {
2509 			rv = NDI_FAILURE;
2510 			goto out;
2511 		}
2512 	}
2513 
2514 	ASSERT(i_ddi_node_state(rdip) >= DS_INITIALIZED);
2515 
2516 	devnm = kmem_alloc(MAXNAMELEN + 1, KM_SLEEP);
2517 
2518 	(void) ddi_deviname(rdip, devnm);
2519 
2520 	if ((rv = ndi_devi_config_one(pdip, devnm+1, &rdip,
2521 	    NDI_DEVI_ONLINE | NDI_CONFIG)) == NDI_SUCCESS) {
2522 		/* release hold from ndi_devi_config_one() */
2523 		ndi_rele_devi(rdip);
2524 	}
2525 
2526 	kmem_free(devnm, MAXNAMELEN + 1);
2527 out:
2528 	if (rv != NDI_SUCCESS && dipp && rdip) {
2529 		ndi_hold_devi(rdip);
2530 		*dipp = rdip;
2531 	}
2532 	ndi_rele_devi(pdip);
2533 	return (ndi2errno(rv));
2534 }
2535 
2536 void
2537 e_ddi_branch_hold(dev_info_t *rdip)
2538 {
2539 	if (e_ddi_branch_held(rdip)) {
2540 		cmn_err(CE_WARN, "e_ddi_branch_hold: branch already held");
2541 		return;
2542 	}
2543 
2544 	mutex_enter(&DEVI(rdip)->devi_lock);
2545 	if ((DEVI(rdip)->devi_flags & DEVI_BRANCH_HELD) == 0) {
2546 		DEVI(rdip)->devi_flags |= DEVI_BRANCH_HELD;
2547 		DEVI(rdip)->devi_ref++;
2548 	}
2549 	ASSERT(DEVI(rdip)->devi_ref > 0);
2550 	mutex_exit(&DEVI(rdip)->devi_lock);
2551 }
2552 
2553 int
2554 e_ddi_branch_held(dev_info_t *rdip)
2555 {
2556 	int rv = 0;
2557 
2558 	mutex_enter(&DEVI(rdip)->devi_lock);
2559 	if ((DEVI(rdip)->devi_flags & DEVI_BRANCH_HELD) &&
2560 	    DEVI(rdip)->devi_ref > 0) {
2561 		rv = 1;
2562 	}
2563 	mutex_exit(&DEVI(rdip)->devi_lock);
2564 
2565 	return (rv);
2566 }
2567 void
2568 e_ddi_branch_rele(dev_info_t *rdip)
2569 {
2570 	mutex_enter(&DEVI(rdip)->devi_lock);
2571 	DEVI(rdip)->devi_flags &= ~DEVI_BRANCH_HELD;
2572 	DEVI(rdip)->devi_ref--;
2573 	mutex_exit(&DEVI(rdip)->devi_lock);
2574 }
2575 
2576 int
2577 e_ddi_branch_unconfigure(
2578 	dev_info_t *rdip,
2579 	dev_info_t **dipp,
2580 	uint_t flags)
2581 {
2582 	int	circ, rv;
2583 	int	destroy;
2584 	char	*devnm;
2585 	uint_t	nflags;
2586 	dev_info_t *pdip;
2587 
2588 	if (dipp)
2589 		*dipp = NULL;
2590 
2591 	if (rdip == NULL)
2592 		return (EINVAL);
2593 
2594 	pdip = ddi_get_parent(rdip);
2595 
2596 	ASSERT(pdip);
2597 
2598 	/*
2599 	 * Check if caller holds pdip busy - can cause deadlocks during
2600 	 * devfs_clean()
2601 	 */
2602 	if (DEVI_BUSY_OWNED(pdip)) {
2603 		cmn_err(CE_WARN, "e_ddi_branch_unconfigure: failed: parent"
2604 		    " devinfo node(%p) is busy held", (void *)pdip);
2605 		return (EINVAL);
2606 	}
2607 
2608 	destroy = (flags & DEVI_BRANCH_DESTROY) ? 1 : 0;
2609 
2610 	devnm = kmem_alloc(MAXNAMELEN + 1, KM_SLEEP);
2611 
2612 	ndi_devi_enter(pdip, &circ);
2613 	(void) ddi_deviname(rdip, devnm);
2614 	ndi_devi_exit(pdip, circ);
2615 
2616 	/*
2617 	 * ddi_deviname() returns a component name with / prepended.
2618 	 */
2619 	(void) devfs_clean(pdip, devnm + 1, DV_CLEAN_FORCE);
2620 
2621 	ndi_devi_enter(pdip, &circ);
2622 
2623 	/*
2624 	 * Recreate device name as it may have changed state (init/uninit)
2625 	 * when parent busy lock was dropped for devfs_clean()
2626 	 */
2627 	(void) ddi_deviname(rdip, devnm);
2628 
2629 	if (!e_ddi_branch_held(rdip)) {
2630 		kmem_free(devnm, MAXNAMELEN + 1);
2631 		ndi_devi_exit(pdip, circ);
2632 		cmn_err(CE_WARN, "e_ddi_%s_branch: dip(%p) not held",
2633 		    destroy ? "destroy" : "unconfigure", (void *)rdip);
2634 		return (EINVAL);
2635 	}
2636 
2637 	/*
2638 	 * Release hold on the branch. This is ok since we are holding the
2639 	 * parent busy. If rdip is not removed, we must do a hold on the
2640 	 * branch before returning.
2641 	 */
2642 	e_ddi_branch_rele(rdip);
2643 
2644 	nflags = NDI_DEVI_OFFLINE;
2645 	if (destroy || (flags & DEVI_BRANCH_DESTROY)) {
2646 		nflags |= NDI_DEVI_REMOVE;
2647 		destroy = 1;
2648 	} else {
2649 		nflags |= NDI_UNCONFIG;		/* uninit but don't remove */
2650 	}
2651 
2652 	if (flags & DEVI_BRANCH_EVENT)
2653 		nflags |= NDI_POST_EVENT;
2654 
2655 	if (i_ddi_devi_attached(pdip) &&
2656 	    (i_ddi_node_state(rdip) >= DS_INITIALIZED)) {
2657 		rv = ndi_devi_unconfig_one(pdip, devnm+1, dipp, nflags);
2658 	} else {
2659 		rv = e_ddi_devi_unconfig(rdip, dipp, nflags);
2660 		if (rv == NDI_SUCCESS) {
2661 			ASSERT(!destroy || ddi_get_child(rdip) == NULL);
2662 			rv = ndi_devi_offline(rdip, nflags);
2663 		}
2664 	}
2665 
2666 	if (!destroy || rv != NDI_SUCCESS) {
2667 		/* The dip still exists, so do a hold */
2668 		e_ddi_branch_hold(rdip);
2669 	}
2670 out:
2671 	kmem_free(devnm, MAXNAMELEN + 1);
2672 	ndi_devi_exit(pdip, circ);
2673 	return (ndi2errno(rv));
2674 }
2675 
2676 int
2677 e_ddi_branch_destroy(dev_info_t *rdip, dev_info_t **dipp, uint_t flag)
2678 {
2679 	return (e_ddi_branch_unconfigure(rdip, dipp,
2680 	    flag|DEVI_BRANCH_DESTROY));
2681 }
2682 
2683 /*
2684  * Number of chains for hash table
2685  */
2686 #define	NUMCHAINS	17
2687 
2688 /*
2689  * Devinfo busy arg
2690  */
2691 struct devi_busy {
2692 	int dv_total;
2693 	int s_total;
2694 	mod_hash_t *dv_hash;
2695 	mod_hash_t *s_hash;
2696 	int (*callback)(dev_info_t *, void *, uint_t);
2697 	void *arg;
2698 };
2699 
2700 static int
2701 visit_dip(dev_info_t *dip, void *arg)
2702 {
2703 	uintptr_t sbusy, dvbusy, ref;
2704 	struct devi_busy *bsp = arg;
2705 
2706 	ASSERT(bsp->callback);
2707 
2708 	/*
2709 	 * A dip cannot be busy if its reference count is 0
2710 	 */
2711 	if ((ref = e_ddi_devi_holdcnt(dip)) == 0) {
2712 		return (bsp->callback(dip, bsp->arg, 0));
2713 	}
2714 
2715 	if (mod_hash_find(bsp->dv_hash, dip, (mod_hash_val_t *)&dvbusy))
2716 		dvbusy = 0;
2717 
2718 	/*
2719 	 * To catch device opens currently maintained on specfs common snodes.
2720 	 */
2721 	if (mod_hash_find(bsp->s_hash, dip, (mod_hash_val_t *)&sbusy))
2722 		sbusy = 0;
2723 
2724 #ifdef	DEBUG
2725 	if (ref < sbusy || ref < dvbusy) {
2726 		cmn_err(CE_WARN, "dip(%p): sopen = %lu, dvopen = %lu "
2727 		    "dip ref = %lu\n", (void *)dip, sbusy, dvbusy, ref);
2728 	}
2729 #endif
2730 
2731 	dvbusy = (sbusy > dvbusy) ? sbusy : dvbusy;
2732 
2733 	return (bsp->callback(dip, bsp->arg, dvbusy));
2734 }
2735 
2736 static int
2737 visit_snode(struct snode *sp, void *arg)
2738 {
2739 	uintptr_t sbusy;
2740 	dev_info_t *dip;
2741 	int count;
2742 	struct devi_busy *bsp = arg;
2743 
2744 	ASSERT(sp);
2745 
2746 	/*
2747 	 * The stable lock is held. This prevents
2748 	 * the snode and its associated dip from
2749 	 * going away.
2750 	 */
2751 	dip = NULL;
2752 	count = spec_devi_open_count(sp, &dip);
2753 
2754 	if (count <= 0)
2755 		return (DDI_WALK_CONTINUE);
2756 
2757 	ASSERT(dip);
2758 
2759 	if (mod_hash_remove(bsp->s_hash, dip, (mod_hash_val_t *)&sbusy))
2760 		sbusy = count;
2761 	else
2762 		sbusy += count;
2763 
2764 	if (mod_hash_insert(bsp->s_hash, dip, (mod_hash_val_t)sbusy)) {
2765 		cmn_err(CE_WARN, "%s: s_hash insert failed: dip=0x%p, "
2766 		    "sbusy = %lu", "e_ddi_branch_referenced",
2767 		    (void *)dip, sbusy);
2768 	}
2769 
2770 	bsp->s_total += count;
2771 
2772 	return (DDI_WALK_CONTINUE);
2773 }
2774 
2775 static void
2776 visit_dvnode(struct dv_node *dv, void *arg)
2777 {
2778 	uintptr_t dvbusy;
2779 	uint_t count;
2780 	struct vnode *vp;
2781 	struct devi_busy *bsp = arg;
2782 
2783 	ASSERT(dv && dv->dv_devi);
2784 
2785 	vp = DVTOV(dv);
2786 
2787 	mutex_enter(&vp->v_lock);
2788 	count = vp->v_count;
2789 	mutex_exit(&vp->v_lock);
2790 
2791 	if (!count)
2792 		return;
2793 
2794 	if (mod_hash_remove(bsp->dv_hash, dv->dv_devi,
2795 	    (mod_hash_val_t *)&dvbusy))
2796 		dvbusy = count;
2797 	else
2798 		dvbusy += count;
2799 
2800 	if (mod_hash_insert(bsp->dv_hash, dv->dv_devi,
2801 	    (mod_hash_val_t)dvbusy)) {
2802 		cmn_err(CE_WARN, "%s: dv_hash insert failed: dip=0x%p, "
2803 		    "dvbusy=%lu", "e_ddi_branch_referenced",
2804 		    (void *)dv->dv_devi, dvbusy);
2805 	}
2806 
2807 	bsp->dv_total += count;
2808 }
2809 
2810 /*
2811  * Returns reference count on success or -1 on failure.
2812  */
2813 int
2814 e_ddi_branch_referenced(
2815 	dev_info_t *rdip,
2816 	int (*callback)(dev_info_t *dip, void *arg, uint_t ref),
2817 	void *arg)
2818 {
2819 	int circ;
2820 	char *path;
2821 	dev_info_t *pdip;
2822 	struct devi_busy bsa = {0};
2823 
2824 	ASSERT(rdip);
2825 
2826 	path = kmem_alloc(MAXPATHLEN, KM_SLEEP);
2827 
2828 	ndi_hold_devi(rdip);
2829 
2830 	pdip = ddi_get_parent(rdip);
2831 
2832 	ASSERT(pdip);
2833 
2834 	/*
2835 	 * Check if caller holds pdip busy - can cause deadlocks during
2836 	 * devfs_walk()
2837 	 */
2838 	if (!e_ddi_branch_held(rdip) || DEVI_BUSY_OWNED(pdip)) {
2839 		cmn_err(CE_WARN, "e_ddi_branch_referenced: failed: "
2840 		    "devinfo branch(%p) not held or parent busy held",
2841 		    (void *)rdip);
2842 		ndi_rele_devi(rdip);
2843 		kmem_free(path, MAXPATHLEN);
2844 		return (-1);
2845 	}
2846 
2847 	ndi_devi_enter(pdip, &circ);
2848 	(void) ddi_pathname(rdip, path);
2849 	ndi_devi_exit(pdip, circ);
2850 
2851 	bsa.dv_hash = mod_hash_create_ptrhash("dv_node busy hash", NUMCHAINS,
2852 	    mod_hash_null_valdtor, sizeof (struct dev_info));
2853 
2854 	bsa.s_hash = mod_hash_create_ptrhash("snode busy hash", NUMCHAINS,
2855 	    mod_hash_null_valdtor, sizeof (struct snode));
2856 
2857 	if (devfs_walk(path, visit_dvnode, &bsa)) {
2858 		cmn_err(CE_WARN, "e_ddi_branch_referenced: "
2859 		    "devfs walk failed for: %s", path);
2860 		kmem_free(path, MAXPATHLEN);
2861 		bsa.s_total = bsa.dv_total = -1;
2862 		goto out;
2863 	}
2864 
2865 	kmem_free(path, MAXPATHLEN);
2866 
2867 	/*
2868 	 * Walk the snode table to detect device opens, which are currently
2869 	 * maintained on specfs common snodes.
2870 	 */
2871 	spec_snode_walk(visit_snode, &bsa);
2872 
2873 	if (callback == NULL)
2874 		goto out;
2875 
2876 	bsa.callback = callback;
2877 	bsa.arg = arg;
2878 
2879 	if (visit_dip(rdip, &bsa) == DDI_WALK_CONTINUE) {
2880 		ndi_devi_enter(rdip, &circ);
2881 		ddi_walk_devs(ddi_get_child(rdip), visit_dip, &bsa);
2882 		ndi_devi_exit(rdip, circ);
2883 	}
2884 
2885 out:
2886 	ndi_rele_devi(rdip);
2887 	mod_hash_destroy_ptrhash(bsa.s_hash);
2888 	mod_hash_destroy_ptrhash(bsa.dv_hash);
2889 	return (bsa.s_total > bsa.dv_total ? bsa.s_total : bsa.dv_total);
2890 }
2891