xref: /freebsd/sys/dev/bhnd/bhnd_subr.c (revision 9dbf5b0e)
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause
3  *
4  * Copyright (c) 2015-2016 Landon Fuller <landon@landonf.org>
5  * Copyright (c) 2017 The FreeBSD Foundation
6  * All rights reserved.
7  *
8  * Portions of this software were developed by Landon Fuller
9  * under sponsorship from the FreeBSD Foundation.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions and the following disclaimer,
16  *    without modification.
17  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
18  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
19  *    redistribution must be conditioned upon including a substantially
20  *    similar Disclaimer requirement for further binary redistribution.
21  *
22  * NO WARRANTY
23  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
24  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
25  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
26  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
27  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
28  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
30  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
31  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
33  * THE POSSIBILITY OF SUCH DAMAGES.
34  */
35 
36 #include <sys/param.h>
37 #include <sys/bus.h>
38 #include <sys/refcount.h>
39 #include <sys/systm.h>
40 
41 #include <machine/bus.h>
42 #include <sys/rman.h>
43 #include <machine/resource.h>
44 
45 #include <dev/bhnd/siba/sibareg.h>
46 
47 #include <dev/bhnd/cores/chipc/chipcreg.h>
48 
49 #include "nvram/bhnd_nvram.h"
50 
51 #include "bhnd_chipc_if.h"
52 
53 #include "bhnd_nvram_if.h"
54 #include "bhnd_nvram_map.h"
55 
56 #include "bhndreg.h"
57 #include "bhndvar.h"
58 #include "bhnd_private.h"
59 
60 static void	bhnd_service_registry_free_entry(
61 		    struct bhnd_service_entry *entry);
62 
63 static int	compare_ascending_probe_order(const void *lhs, const void *rhs);
64 static int	compare_descending_probe_order(const void *lhs,
65 		    const void *rhs);
66 
67 /* BHND core device description table. */
68 static const struct bhnd_core_desc {
69 	uint16_t	 vendor;
70 	uint16_t	 device;
71 	bhnd_devclass_t	 class;
72 	const char	*desc;
73 } bhnd_core_descs[] = {
74 	#define	BHND_CDESC(_mfg, _cid, _cls, _desc)		\
75 	    { BHND_MFGID_ ## _mfg, BHND_COREID_ ## _cid,	\
76 		BHND_DEVCLASS_ ## _cls, _desc }
77 
78 	BHND_CDESC(BCM, CC,		CC,		"ChipCommon I/O Controller"),
79 	BHND_CDESC(BCM, ILINE20,	OTHER,		"iLine20 HPNA"),
80 	BHND_CDESC(BCM, SRAM,		RAM,		"SRAM"),
81 	BHND_CDESC(BCM, SDRAM,		RAM,		"SDRAM"),
82 	BHND_CDESC(BCM, PCI,		PCI,		"PCI Bridge"),
83 	BHND_CDESC(BCM, MIPS,		CPU,		"BMIPS CPU"),
84 	BHND_CDESC(BCM, ENET,		ENET_MAC,	"Fast Ethernet MAC"),
85 	BHND_CDESC(BCM, V90_CODEC,	SOFTMODEM,	"V.90 SoftModem Codec"),
86 	BHND_CDESC(BCM, USB,		USB_DUAL,	"USB 1.1 Device/Host Controller"),
87 	BHND_CDESC(BCM, ADSL,		OTHER,		"ADSL Core"),
88 	BHND_CDESC(BCM, ILINE100,	OTHER,		"iLine100 HPNA"),
89 	BHND_CDESC(BCM, IPSEC,		OTHER,		"IPsec Accelerator"),
90 	BHND_CDESC(BCM, UTOPIA,		OTHER,		"UTOPIA ATM Core"),
91 	BHND_CDESC(BCM, PCMCIA,		PCCARD,		"PCMCIA Bridge"),
92 	BHND_CDESC(BCM, SOCRAM,		RAM,		"Internal Memory"),
93 	BHND_CDESC(BCM, MEMC,		MEMC,		"MEMC SDRAM Controller"),
94 	BHND_CDESC(BCM, OFDM,		OTHER,		"OFDM PHY"),
95 	BHND_CDESC(BCM, EXTIF,		OTHER,		"External Interface"),
96 	BHND_CDESC(BCM, D11,		WLAN,		"802.11 MAC/PHY/Radio"),
97 	BHND_CDESC(BCM, APHY,		WLAN_PHY,	"802.11a PHY"),
98 	BHND_CDESC(BCM, BPHY,		WLAN_PHY,	"802.11b PHY"),
99 	BHND_CDESC(BCM, GPHY,		WLAN_PHY,	"802.11g PHY"),
100 	BHND_CDESC(BCM, MIPS33,		CPU,		"BMIPS33 CPU"),
101 	BHND_CDESC(BCM, USB11H,		USB_HOST,	"USB 1.1 Host Controller"),
102 	BHND_CDESC(BCM, USB11D,		USB_DEV,	"USB 1.1 Device Controller"),
103 	BHND_CDESC(BCM, USB20H,		USB_HOST,	"USB 2.0 Host Controller"),
104 	BHND_CDESC(BCM, USB20D,		USB_DEV,	"USB 2.0 Device Controller"),
105 	BHND_CDESC(BCM, SDIOH,		OTHER,		"SDIO Host Controller"),
106 	BHND_CDESC(BCM, ROBO,		OTHER,		"RoboSwitch"),
107 	BHND_CDESC(BCM, ATA100,		OTHER,		"Parallel ATA Controller"),
108 	BHND_CDESC(BCM, SATAXOR,	OTHER,		"SATA DMA/XOR Controller"),
109 	BHND_CDESC(BCM, GIGETH,		ENET_MAC,	"Gigabit Ethernet MAC"),
110 	BHND_CDESC(BCM, PCIE,		PCIE,		"PCIe Bridge"),
111 	BHND_CDESC(BCM, NPHY,		WLAN_PHY,	"802.11n 2x2 PHY"),
112 	BHND_CDESC(BCM, SRAMC,		MEMC,		"SRAM Controller"),
113 	BHND_CDESC(BCM, MINIMAC,	OTHER,		"MINI MAC/PHY"),
114 	BHND_CDESC(BCM, ARM11,		CPU,		"ARM1176 CPU"),
115 	BHND_CDESC(BCM, ARM7S,		CPU,		"ARM7TDMI-S CPU"),
116 	BHND_CDESC(BCM, LPPHY,		WLAN_PHY,	"802.11a/b/g PHY"),
117 	BHND_CDESC(BCM, PMU,		PMU,		"PMU"),
118 	BHND_CDESC(BCM, SSNPHY,		WLAN_PHY,	"802.11n Single-Stream PHY"),
119 	BHND_CDESC(BCM, SDIOD,		OTHER,		"SDIO Device Core"),
120 	BHND_CDESC(BCM, ARMCM3,		CPU,		"ARM Cortex-M3 CPU"),
121 	BHND_CDESC(BCM, HTPHY,		WLAN_PHY,	"802.11n 4x4 PHY"),
122 	BHND_CDESC(MIPS,MIPS74K,	CPU,		"MIPS74k CPU"),
123 	BHND_CDESC(BCM, GMAC,		ENET_MAC,	"Gigabit MAC core"),
124 	BHND_CDESC(BCM, DMEMC,		MEMC,		"DDR1/DDR2 Memory Controller"),
125 	BHND_CDESC(BCM, PCIERC,		OTHER,		"PCIe Root Complex"),
126 	BHND_CDESC(BCM, OCP,		SOC_BRIDGE,	"OCP to OCP Bridge"),
127 	BHND_CDESC(BCM, SC,		OTHER,		"Shared Common Core"),
128 	BHND_CDESC(BCM, AHB,		SOC_BRIDGE,	"OCP to AHB Bridge"),
129 	BHND_CDESC(BCM, SPIH,		OTHER,		"SPI Host Controller"),
130 	BHND_CDESC(BCM, I2S,		OTHER,		"I2S Digital Audio Interface"),
131 	BHND_CDESC(BCM, DMEMS,		MEMC,		"SDR/DDR1 Memory Controller"),
132 	BHND_CDESC(BCM, UBUS_SHIM,	OTHER,		"BCM6362/UBUS WLAN SHIM"),
133 	BHND_CDESC(BCM, PCIE2,		PCIE,		"PCIe Bridge (Gen2)"),
134 
135 	BHND_CDESC(ARM, APB_BRIDGE,	SOC_BRIDGE,	"BP135 AMBA3 AXI to APB Bridge"),
136 	BHND_CDESC(ARM, PL301,		SOC_ROUTER,	"PL301 AMBA3 Interconnect"),
137 	BHND_CDESC(ARM, EROM,		EROM,		"PL366 Device Enumeration ROM"),
138 	BHND_CDESC(ARM, OOB_ROUTER,	OTHER,		"PL367 OOB Interrupt Router"),
139 	BHND_CDESC(ARM, AXI_UNMAPPED,	OTHER,		"Unmapped Address Ranges"),
140 
141 	BHND_CDESC(BCM, 4706_CC,	CC,		"ChipCommon I/O Controller"),
142 	BHND_CDESC(BCM, NS_PCIE2,	PCIE,		"PCIe Bridge (Gen2)"),
143 	BHND_CDESC(BCM, NS_DMA,		OTHER,		"DMA engine"),
144 	BHND_CDESC(BCM, NS_SDIO,	OTHER,		"SDIO 3.0 Host Controller"),
145 	BHND_CDESC(BCM, NS_USB20H,	USB_HOST,	"USB 2.0 Host Controller"),
146 	BHND_CDESC(BCM, NS_USB30H,	USB_HOST,	"USB 3.0 Host Controller"),
147 	BHND_CDESC(BCM, NS_A9JTAG,	OTHER,		"ARM Cortex A9 JTAG Interface"),
148 	BHND_CDESC(BCM, NS_DDR23_MEMC,	MEMC,		"Denali DDR2/DD3 Memory Controller"),
149 	BHND_CDESC(BCM, NS_ROM,		NVRAM,		"System ROM"),
150 	BHND_CDESC(BCM, NS_NAND,	NVRAM,		"NAND Flash Controller"),
151 	BHND_CDESC(BCM, NS_QSPI,	NVRAM,		"QSPI Flash Controller"),
152 	BHND_CDESC(BCM, NS_CC_B,	CC_B,		"ChipCommon B Auxiliary I/O Controller"),
153 	BHND_CDESC(BCM, 4706_SOCRAM,	RAM,		"Internal Memory"),
154 	BHND_CDESC(BCM, IHOST_ARMCA9,	CPU,		"ARM Cortex A9 CPU"),
155 	BHND_CDESC(BCM, 4706_GMAC_CMN,	ENET,		"Gigabit MAC (Common)"),
156 	BHND_CDESC(BCM, 4706_GMAC,	ENET_MAC,	"Gigabit MAC"),
157 	BHND_CDESC(BCM, AMEMC,		MEMC,		"Denali DDR1/DDR2 Memory Controller"),
158 #undef	BHND_CDESC
159 
160 	/* Derived from inspection of the BCM4331 cores that provide PrimeCell
161 	 * IDs. Due to lack of documentation, the surmised device name/purpose
162 	 * provided here may be incorrect. */
163 	{ BHND_MFGID_ARM,	BHND_PRIMEID_EROM,	BHND_DEVCLASS_OTHER,
164 	    "PL364 Device Enumeration ROM" },
165 	{ BHND_MFGID_ARM,	BHND_PRIMEID_SWRAP,	BHND_DEVCLASS_OTHER,
166 	    "PL368 Device Management Interface" },
167 	{ BHND_MFGID_ARM,	BHND_PRIMEID_MWRAP,	BHND_DEVCLASS_OTHER,
168 	    "PL369 Device Management Interface" },
169 	{ 0, 0, 0, NULL }
170 };
171 
172 static const struct bhnd_device_quirk bhnd_chipc_clkctl_quirks[];
173 static const struct bhnd_device_quirk bhnd_pcmcia_clkctl_quirks[];
174 
175 /**
176  * Device table entries for core-specific CLKCTL quirk lookup.
177  */
178 static const struct bhnd_device bhnd_clkctl_devices[] = {
179 	BHND_DEVICE(BCM, CC,		NULL,	bhnd_chipc_clkctl_quirks),
180 	BHND_DEVICE(BCM, PCMCIA,	NULL,	bhnd_pcmcia_clkctl_quirks),
181 	BHND_DEVICE_END,
182 };
183 
184 /** ChipCommon CLKCTL quirks */
185 static const struct bhnd_device_quirk bhnd_chipc_clkctl_quirks[] = {
186 	/* HTAVAIL/ALPAVAIL are bitswapped in chipc's CLKCTL */
187 	BHND_CHIP_QUIRK(4328,	HWREV_ANY,	BHND_CLKCTL_QUIRK_CCS0),
188 	BHND_CHIP_QUIRK(5354,	HWREV_ANY,	BHND_CLKCTL_QUIRK_CCS0),
189 	BHND_DEVICE_QUIRK_END
190 };
191 
192 /** PCMCIA CLKCTL quirks */
193 static const struct bhnd_device_quirk bhnd_pcmcia_clkctl_quirks[] = {
194 	/* HTAVAIL/ALPAVAIL are bitswapped in pcmcia's CLKCTL */
195 	BHND_CHIP_QUIRK(4328,	HWREV_ANY,	BHND_CLKCTL_QUIRK_CCS0),
196 	BHND_CHIP_QUIRK(5354,	HWREV_ANY,	BHND_CLKCTL_QUIRK_CCS0),
197 	BHND_DEVICE_QUIRK_END
198 };
199 
200 /**
201  * Return the name for a given JEP106 manufacturer ID.
202  *
203  * @param vendor A JEP106 Manufacturer ID, including the non-standard ARM 4-bit
204  * JEP106 continuation code.
205  */
206 const char *
bhnd_vendor_name(uint16_t vendor)207 bhnd_vendor_name(uint16_t vendor)
208 {
209 	switch (vendor) {
210 	case BHND_MFGID_ARM:
211 		return "ARM";
212 	case BHND_MFGID_BCM:
213 		return "Broadcom";
214 	case BHND_MFGID_MIPS:
215 		return "MIPS";
216 	default:
217 		return "unknown";
218 	}
219 }
220 
221 /**
222  * Return the name of a port type.
223  *
224  * @param port_type The port type to look up.
225  */
226 const char *
bhnd_port_type_name(bhnd_port_type port_type)227 bhnd_port_type_name(bhnd_port_type port_type)
228 {
229 	switch (port_type) {
230 	case BHND_PORT_DEVICE:
231 		return ("device");
232 	case BHND_PORT_BRIDGE:
233 		return ("bridge");
234 	case BHND_PORT_AGENT:
235 		return ("agent");
236 	default:
237 		return "unknown";
238 	}
239 }
240 
241 /**
242  * Return the name of an NVRAM source.
243  *
244  * @param nvram_src The NVRAM source type to look up.
245  */
246 const char *
bhnd_nvram_src_name(bhnd_nvram_src nvram_src)247 bhnd_nvram_src_name(bhnd_nvram_src nvram_src)
248 {
249 	switch (nvram_src) {
250 	case BHND_NVRAM_SRC_FLASH:
251 		return ("flash");
252 	case BHND_NVRAM_SRC_OTP:
253 		return ("OTP");
254 	case BHND_NVRAM_SRC_SPROM:
255 		return ("SPROM");
256 	case BHND_NVRAM_SRC_UNKNOWN:
257 		return ("none");
258 	default:
259 		return ("unknown");
260 	}
261 }
262 
263 static const struct bhnd_core_desc *
bhnd_find_core_desc(uint16_t vendor,uint16_t device)264 bhnd_find_core_desc(uint16_t vendor, uint16_t device)
265 {
266 	for (u_int i = 0; bhnd_core_descs[i].desc != NULL; i++) {
267 		if (bhnd_core_descs[i].vendor != vendor)
268 			continue;
269 
270 		if (bhnd_core_descs[i].device != device)
271 			continue;
272 
273 		return (&bhnd_core_descs[i]);
274 	}
275 
276 	return (NULL);
277 }
278 
279 /**
280  * Return a human-readable name for a BHND core.
281  *
282  * @param vendor The core designer's JEDEC-106 Manufacturer ID.
283  * @param device The core identifier.
284  */
285 const char *
bhnd_find_core_name(uint16_t vendor,uint16_t device)286 bhnd_find_core_name(uint16_t vendor, uint16_t device)
287 {
288 	const struct bhnd_core_desc *desc;
289 
290 	if ((desc = bhnd_find_core_desc(vendor, device)) == NULL)
291 		return ("unknown");
292 
293 	return desc->desc;
294 }
295 
296 /**
297  * Return the device class for a BHND core.
298  *
299  * @param vendor The core designer's JEDEC-106 Manufacturer ID.
300  * @param device The core identifier.
301  */
302 bhnd_devclass_t
bhnd_find_core_class(uint16_t vendor,uint16_t device)303 bhnd_find_core_class(uint16_t vendor, uint16_t device)
304 {
305 	const struct bhnd_core_desc *desc;
306 
307 	if ((desc = bhnd_find_core_desc(vendor, device)) == NULL)
308 		return (BHND_DEVCLASS_OTHER);
309 
310 	return desc->class;
311 }
312 
313 /**
314  * Return a human-readable name for a BHND core.
315  *
316  * @param ci The core's info record.
317  */
318 const char *
bhnd_core_name(const struct bhnd_core_info * ci)319 bhnd_core_name(const struct bhnd_core_info *ci)
320 {
321 	return bhnd_find_core_name(ci->vendor, ci->device);
322 }
323 
324 /**
325  * Return the device class for a BHND core.
326  *
327  * @param ci The core's info record.
328  */
329 bhnd_devclass_t
bhnd_core_class(const struct bhnd_core_info * ci)330 bhnd_core_class(const struct bhnd_core_info *ci)
331 {
332 	return bhnd_find_core_class(ci->vendor, ci->device);
333 }
334 
335 /**
336  * Write a human readable name representation of the given
337  * BHND_CHIPID_* constant to @p buffer.
338  *
339  * @param buffer Output buffer, or NULL to compute the required size.
340  * @param size Capacity of @p buffer, in bytes.
341  * @param chip_id Chip ID to be formatted.
342  *
343  * @return The required number of bytes on success, or a negative integer on
344  * failure. No more than @p size-1 characters be written, with the @p size'th
345  * set to '\0'.
346  *
347  * @sa BHND_CHIPID_MAX_NAMELEN
348  */
349 int
bhnd_format_chip_id(char * buffer,size_t size,uint16_t chip_id)350 bhnd_format_chip_id(char *buffer, size_t size, uint16_t chip_id)
351 {
352 	/* All hex formatted IDs are within the range of 0x4000-0x9C3F (40000-1) */
353 	if (chip_id >= 0x4000 && chip_id <= 0x9C3F)
354 		return (snprintf(buffer, size, "BCM%hX", chip_id));
355 	else
356 		return (snprintf(buffer, size, "BCM%hu", chip_id));
357 }
358 
359 /**
360  * Return a core info record populated from a bhnd-attached @p dev.
361  *
362  * @param dev A bhnd device.
363  *
364  * @return A core info record for @p dev.
365  */
366 struct bhnd_core_info
bhnd_get_core_info(device_t dev)367 bhnd_get_core_info(device_t dev) {
368 	return (struct bhnd_core_info) {
369 		.vendor		= bhnd_get_vendor(dev),
370 		.device		= bhnd_get_device(dev),
371 		.hwrev		= bhnd_get_hwrev(dev),
372 		.core_idx	= bhnd_get_core_index(dev),
373 		.unit		= bhnd_get_core_unit(dev)
374 	};
375 }
376 
377 /**
378  * Find a @p class child device with @p unit on @p bus.
379  *
380  * @param bus The bhnd-compatible bus to be searched.
381  * @param class The device class to match on.
382  * @param unit The core unit number; specify -1 to return the first match
383  * regardless of unit number.
384  *
385  * @retval device_t if a matching child device is found.
386  * @retval NULL if no matching child device is found.
387  */
388 device_t
bhnd_bus_find_child(device_t bus,bhnd_devclass_t class,int unit)389 bhnd_bus_find_child(device_t bus, bhnd_devclass_t class, int unit)
390 {
391 	struct bhnd_core_match md = {
392 		BHND_MATCH_CORE_CLASS(class),
393 		BHND_MATCH_CORE_UNIT(unit)
394 	};
395 
396 	if (unit == -1)
397 		md.m.match.core_unit = 0;
398 
399 	return bhnd_bus_match_child(bus, &md);
400 }
401 
402 /**
403  * Find the first child device on @p bus that matches @p desc.
404  *
405  * @param bus The bhnd-compatible bus to be searched.
406  * @param desc A match descriptor.
407  *
408  * @retval device_t if a matching child device is found.
409  * @retval NULL if no matching child device is found.
410  */
411 device_t
bhnd_bus_match_child(device_t bus,const struct bhnd_core_match * desc)412 bhnd_bus_match_child(device_t bus, const struct bhnd_core_match *desc)
413 {
414 	device_t	*devlistp;
415 	device_t	 match;
416 	int		 devcnt;
417 	int		 error;
418 
419 	error = device_get_children(bus, &devlistp, &devcnt);
420 	if (error != 0)
421 		return (NULL);
422 
423 	match = NULL;
424 	for (int i = 0; i < devcnt; i++) {
425 		struct bhnd_core_info ci = bhnd_get_core_info(devlistp[i]);
426 
427 		if (bhnd_core_matches(&ci, desc)) {
428 			match = devlistp[i];
429 			goto done;
430 		}
431 	}
432 
433 done:
434 	free(devlistp, M_TEMP);
435 	return match;
436 }
437 
438 /**
439  * Retrieve an ordered list of all device instances currently connected to
440  * @p bus, returning a pointer to the array in @p devlistp and the count
441  * in @p ndevs.
442  *
443  * The memory allocated for the table must be freed via
444  * bhnd_bus_free_children().
445  *
446  * @param	bus		The bhnd-compatible bus to be queried.
447  * @param[out]	devlist		The array of devices.
448  * @param[out]	devcount	The number of devices in @p devlistp
449  * @param	order		The order in which devices will be returned
450  *				in @p devlist.
451  *
452  * @retval 0		success
453  * @retval non-zero	if an error occurs, a regular unix error code will
454  *			be returned.
455  */
456 int
bhnd_bus_get_children(device_t bus,device_t ** devlist,int * devcount,bhnd_device_order order)457 bhnd_bus_get_children(device_t bus, device_t **devlist, int *devcount,
458     bhnd_device_order order)
459 {
460 	int error;
461 
462 	/* Fetch device array */
463 	if ((error = device_get_children(bus, devlist, devcount)))
464 		return (error);
465 
466 	/* Perform requested sorting */
467 	if ((error = bhnd_sort_devices(*devlist, *devcount, order))) {
468 		bhnd_bus_free_children(*devlist);
469 		return (error);
470 	}
471 
472 	return (0);
473 }
474 
475 /**
476  * Free any memory allocated in a previous call to bhnd_bus_get_children().
477  *
478  * @param devlist The device array returned by bhnd_bus_get_children().
479  */
480 void
bhnd_bus_free_children(device_t * devlist)481 bhnd_bus_free_children(device_t *devlist)
482 {
483 	free(devlist, M_TEMP);
484 }
485 
486 /**
487  * Perform in-place sorting of an array of bhnd device instances.
488  *
489  * @param devlist	An array of bhnd devices.
490  * @param devcount	The number of devices in @p devs.
491  * @param order		The sort order to be used.
492  *
493  * @retval 0		success
494  * @retval EINVAL	if the sort order is unknown.
495  */
496 int
bhnd_sort_devices(device_t * devlist,size_t devcount,bhnd_device_order order)497 bhnd_sort_devices(device_t *devlist, size_t devcount, bhnd_device_order order)
498 {
499 	int (*compare)(const void *, const void *);
500 
501 	switch (order) {
502 	case BHND_DEVICE_ORDER_ATTACH:
503 		compare = compare_ascending_probe_order;
504 		break;
505 	case BHND_DEVICE_ORDER_DETACH:
506 		compare = compare_descending_probe_order;
507 		break;
508 	default:
509 		printf("unknown sort order: %d\n", order);
510 		return (EINVAL);
511 	}
512 
513 	qsort(devlist, devcount, sizeof(*devlist), compare);
514 	return (0);
515 }
516 
517 /*
518  * Ascending comparison of bhnd device's probe order.
519  */
520 static int
compare_ascending_probe_order(const void * lhs,const void * rhs)521 compare_ascending_probe_order(const void *lhs, const void *rhs)
522 {
523 	device_t	ldev, rdev;
524 	int		lorder, rorder;
525 
526 	ldev = (*(const device_t *) lhs);
527 	rdev = (*(const device_t *) rhs);
528 
529 	lorder = BHND_BUS_GET_PROBE_ORDER(device_get_parent(ldev), ldev);
530 	rorder = BHND_BUS_GET_PROBE_ORDER(device_get_parent(rdev), rdev);
531 
532 	if (lorder < rorder) {
533 		return (-1);
534 	} else if (lorder > rorder) {
535 		return (1);
536 	} else {
537 		return (0);
538 	}
539 }
540 
541 /*
542  * Descending comparison of bhnd device's probe order.
543  */
544 static int
compare_descending_probe_order(const void * lhs,const void * rhs)545 compare_descending_probe_order(const void *lhs, const void *rhs)
546 {
547 	return (compare_ascending_probe_order(rhs, lhs));
548 }
549 
550 /**
551  * Call device_probe_and_attach() for each of the bhnd bus device's
552  * children, in bhnd attach order.
553  *
554  * @param bus The bhnd-compatible bus for which all children should be probed
555  * and attached.
556  */
557 int
bhnd_bus_probe_children(device_t bus)558 bhnd_bus_probe_children(device_t bus)
559 {
560 	device_t	*devs;
561 	int		 ndevs;
562 	int		 error;
563 
564 	/* Fetch children in attach order */
565 	error = bhnd_bus_get_children(bus, &devs, &ndevs,
566 	    BHND_DEVICE_ORDER_ATTACH);
567 	if (error)
568 		return (error);
569 
570 	/* Probe and attach all children */
571 	for (int i = 0; i < ndevs; i++) {
572 		device_t child = devs[i];
573 		device_probe_and_attach(child);
574 	}
575 
576 	bhnd_bus_free_children(devs);
577 
578 	return (0);
579 }
580 
581 /**
582  * Walk up the bhnd device hierarchy to locate the root device
583  * to which the bhndb bridge is attached.
584  *
585  * This can be used from within bhnd host bridge drivers to locate the
586  * actual upstream host device.
587  *
588  * @param dev A bhnd device.
589  * @param bus_class The expected bus (e.g. "pci") to which the bridge root
590  * should be attached.
591  *
592  * @retval device_t if a matching parent device is found.
593  * @retval NULL if @p dev is not attached via a bhndb bus.
594  * @retval NULL if no parent device is attached via @p bus_class.
595  */
596 device_t
bhnd_find_bridge_root(device_t dev,devclass_t bus_class)597 bhnd_find_bridge_root(device_t dev, devclass_t bus_class)
598 {
599 	devclass_t	bhndb_class;
600 	device_t	parent;
601 
602 	KASSERT(device_get_devclass(device_get_parent(dev)) ==
603 	    devclass_find("bhnd"),
604 	   ("%s not a bhnd device", device_get_nameunit(dev)));
605 
606 	bhndb_class = devclass_find("bhndb");
607 
608 	/* Walk the device tree until we hit a bridge */
609 	parent = dev;
610 	while ((parent = device_get_parent(parent)) != NULL) {
611 		if (device_get_devclass(parent) == bhndb_class)
612 			break;
613 	}
614 
615 	/* No bridge? */
616 	if (parent == NULL)
617 		return (NULL);
618 
619 	/* Search for a parent attached to the expected bus class */
620 	while ((parent = device_get_parent(parent)) != NULL) {
621 		device_t bus;
622 
623 		bus = device_get_parent(parent);
624 		if (bus != NULL && device_get_devclass(bus) == bus_class)
625 			return (parent);
626 	}
627 
628 	/* Not found */
629 	return (NULL);
630 }
631 
632 /**
633  * Find the first core in @p cores that matches @p desc.
634  *
635  * @param cores The table to search.
636  * @param num_cores The length of @p cores.
637  * @param desc A match descriptor.
638  *
639  * @retval bhnd_core_info if a matching core is found.
640  * @retval NULL if no matching core is found.
641  */
642 const struct bhnd_core_info *
bhnd_match_core(const struct bhnd_core_info * cores,u_int num_cores,const struct bhnd_core_match * desc)643 bhnd_match_core(const struct bhnd_core_info *cores, u_int num_cores,
644     const struct bhnd_core_match *desc)
645 {
646 	for (u_int i = 0; i < num_cores; i++) {
647 		if (bhnd_core_matches(&cores[i], desc))
648 			return &cores[i];
649 	}
650 
651 	return (NULL);
652 }
653 
654 /**
655  * Find the first core in @p cores with the given @p class.
656  *
657  * @param cores The table to search.
658  * @param num_cores The length of @p cores.
659  * @param class The device class to match on.
660  *
661  * @retval non-NULL if a matching core is found.
662  * @retval NULL if no matching core is found.
663  */
664 const struct bhnd_core_info *
bhnd_find_core(const struct bhnd_core_info * cores,u_int num_cores,bhnd_devclass_t class)665 bhnd_find_core(const struct bhnd_core_info *cores, u_int num_cores,
666     bhnd_devclass_t class)
667 {
668 	struct bhnd_core_match md = {
669 		BHND_MATCH_CORE_CLASS(class)
670 	};
671 
672 	return bhnd_match_core(cores, num_cores, &md);
673 }
674 
675 /**
676  * Create an equality match descriptor for @p core.
677  *
678  * @param core The core info to be matched on.
679  *
680  * @return an equality match descriptor for @p core.
681  */
682 struct bhnd_core_match
bhnd_core_get_match_desc(const struct bhnd_core_info * core)683 bhnd_core_get_match_desc(const struct bhnd_core_info *core)
684 {
685 	return ((struct bhnd_core_match) {
686 		BHND_MATCH_CORE_VENDOR(core->vendor),
687 		BHND_MATCH_CORE_ID(core->device),
688 		BHND_MATCH_CORE_REV(HWREV_EQ(core->hwrev)),
689 		BHND_MATCH_CORE_CLASS(bhnd_core_class(core)),
690 		BHND_MATCH_CORE_IDX(core->core_idx),
691 		BHND_MATCH_CORE_UNIT(core->unit)
692 	});
693 }
694 
695 /**
696  * Return true if the @p lhs is equal to @p rhs.
697  *
698  * @param lhs The first bhnd core descriptor to compare.
699  * @param rhs The second bhnd core descriptor to compare.
700  *
701  * @retval true if @p lhs is equal to @p rhs
702  * @retval false if @p lhs is not equal to @p rhs
703  */
704 bool
bhnd_cores_equal(const struct bhnd_core_info * lhs,const struct bhnd_core_info * rhs)705 bhnd_cores_equal(const struct bhnd_core_info *lhs,
706     const struct bhnd_core_info *rhs)
707 {
708 	struct bhnd_core_match md;
709 
710 	/* Use an equality match descriptor to perform the comparison */
711 	md = bhnd_core_get_match_desc(rhs);
712 	return (bhnd_core_matches(lhs, &md));
713 }
714 
715 /**
716  * Return true if the @p core matches @p desc.
717  *
718  * @param core A bhnd core descriptor.
719  * @param desc A match descriptor to compare against @p core.
720  *
721  * @retval true if @p core matches @p match.
722  * @retval false if @p core does not match @p match.
723  */
724 bool
bhnd_core_matches(const struct bhnd_core_info * core,const struct bhnd_core_match * desc)725 bhnd_core_matches(const struct bhnd_core_info *core,
726     const struct bhnd_core_match *desc)
727 {
728 	if (desc->m.match.core_vendor && desc->core_vendor != core->vendor)
729 		return (false);
730 
731 	if (desc->m.match.core_id && desc->core_id != core->device)
732 		return (false);
733 
734 	if (desc->m.match.core_unit && desc->core_unit != core->unit)
735 		return (false);
736 
737 	if (desc->m.match.core_rev &&
738 	    !bhnd_hwrev_matches(core->hwrev, &desc->core_rev))
739 		return (false);
740 
741 	if (desc->m.match.core_idx && desc->core_idx != core->core_idx)
742 		return (false);
743 
744 	if (desc->m.match.core_class &&
745 	    desc->core_class != bhnd_core_class(core))
746 		return (false);
747 
748 	return true;
749 }
750 
751 /**
752  * Return true if the @p chip matches @p desc.
753  *
754  * @param chip A bhnd chip identifier.
755  * @param desc A match descriptor to compare against @p chip.
756  *
757  * @retval true if @p chip matches @p match.
758  * @retval false if @p chip does not match @p match.
759  */
760 bool
bhnd_chip_matches(const struct bhnd_chipid * chip,const struct bhnd_chip_match * desc)761 bhnd_chip_matches(const struct bhnd_chipid *chip,
762     const struct bhnd_chip_match *desc)
763 {
764 	if (desc->m.match.chip_id && chip->chip_id != desc->chip_id)
765 		return (false);
766 
767 	if (desc->m.match.chip_pkg && chip->chip_pkg != desc->chip_pkg)
768 		return (false);
769 
770 	if (desc->m.match.chip_rev &&
771 	    !bhnd_hwrev_matches(chip->chip_rev, &desc->chip_rev))
772 		return (false);
773 
774 	if (desc->m.match.chip_type && chip->chip_type != desc->chip_type)
775 		return (false);
776 
777 	return (true);
778 }
779 
780 /**
781  * Return true if the @p board matches @p desc.
782  *
783  * @param board The bhnd board info.
784  * @param desc A match descriptor to compare against @p board.
785  *
786  * @retval true if @p chip matches @p match.
787  * @retval false if @p chip does not match @p match.
788  */
789 bool
bhnd_board_matches(const struct bhnd_board_info * board,const struct bhnd_board_match * desc)790 bhnd_board_matches(const struct bhnd_board_info *board,
791     const struct bhnd_board_match *desc)
792 {
793 	if (desc->m.match.board_srom_rev &&
794 	    !bhnd_hwrev_matches(board->board_srom_rev, &desc->board_srom_rev))
795 		return (false);
796 
797 	if (desc->m.match.board_vendor &&
798 	    board->board_vendor != desc->board_vendor)
799 		return (false);
800 
801 	if (desc->m.match.board_type && board->board_type != desc->board_type)
802 		return (false);
803 
804 	if (desc->m.match.board_devid &&
805 	    board->board_devid != desc->board_devid)
806 		return (false);
807 
808 	if (desc->m.match.board_rev &&
809 	    !bhnd_hwrev_matches(board->board_rev, &desc->board_rev))
810 		return (false);
811 
812 	return (true);
813 }
814 
815 /**
816  * Return true if the @p hwrev matches @p desc.
817  *
818  * @param hwrev A bhnd hardware revision.
819  * @param desc A match descriptor to compare against @p core.
820  *
821  * @retval true if @p hwrev matches @p match.
822  * @retval false if @p hwrev does not match @p match.
823  */
824 bool
bhnd_hwrev_matches(uint16_t hwrev,const struct bhnd_hwrev_match * desc)825 bhnd_hwrev_matches(uint16_t hwrev, const struct bhnd_hwrev_match *desc)
826 {
827 	if (desc->start != BHND_HWREV_INVALID &&
828 	    desc->start > hwrev)
829 		return false;
830 
831 	if (desc->end != BHND_HWREV_INVALID &&
832 	    desc->end < hwrev)
833 		return false;
834 
835 	return true;
836 }
837 
838 /**
839  * Return true if the @p dev matches @p desc.
840  *
841  * @param dev A bhnd device.
842  * @param desc A match descriptor to compare against @p dev.
843  *
844  * @retval true if @p dev matches @p match.
845  * @retval false if @p dev does not match @p match.
846  */
847 bool
bhnd_device_matches(device_t dev,const struct bhnd_device_match * desc)848 bhnd_device_matches(device_t dev, const struct bhnd_device_match *desc)
849 {
850 	struct bhnd_core_info		 core;
851 	const struct bhnd_chipid	*chip;
852 	struct bhnd_board_info		 board;
853 	device_t			 parent;
854 	int				 error;
855 
856 	/* Construct individual match descriptors */
857 	struct bhnd_core_match	m_core	= { _BHND_CORE_MATCH_COPY(desc) };
858 	struct bhnd_chip_match	m_chip	= { _BHND_CHIP_MATCH_COPY(desc) };
859 	struct bhnd_board_match	m_board	= { _BHND_BOARD_MATCH_COPY(desc) };
860 
861 	/* Fetch and match core info */
862 	if (m_core.m.match_flags) {
863 		/* Only applicable to bhnd-attached cores */
864 		parent = device_get_parent(dev);
865 		if (device_get_devclass(parent) != devclass_find("bhnd")) {
866 			device_printf(dev, "attempting to match core "
867 			    "attributes against non-core device\n");
868 			return (false);
869 		}
870 
871 		core = bhnd_get_core_info(dev);
872 		if (!bhnd_core_matches(&core, &m_core))
873 			return (false);
874 	}
875 
876 	/* Fetch and match chip info */
877 	if (m_chip.m.match_flags) {
878 		chip = bhnd_get_chipid(dev);
879 
880 		if (!bhnd_chip_matches(chip, &m_chip))
881 			return (false);
882 	}
883 
884 	/* Fetch and match board info.
885 	 *
886 	 * This is not available until  after NVRAM is up; earlier device
887 	 * matches should not include board requirements */
888 	if (m_board.m.match_flags) {
889 		if ((error = bhnd_read_board_info(dev, &board))) {
890 			device_printf(dev, "failed to read required board info "
891 			    "during device matching: %d\n", error);
892 			return (false);
893 		}
894 
895 		if (!bhnd_board_matches(&board, &m_board))
896 			return (false);
897 	}
898 
899 	/* All matched */
900 	return (true);
901 }
902 
903 /**
904  * Search @p table for an entry matching @p dev.
905  *
906  * @param dev A bhnd device to match against @p table.
907  * @param table The device table to search.
908  * @param entry_size The @p table entry size, in bytes.
909  *
910  * @retval non-NULL the first matching device, if any.
911  * @retval NULL if no matching device is found in @p table.
912  */
913 const struct bhnd_device *
bhnd_device_lookup(device_t dev,const struct bhnd_device * table,size_t entry_size)914 bhnd_device_lookup(device_t dev, const struct bhnd_device *table,
915     size_t entry_size)
916 {
917 	const struct bhnd_device	*entry;
918 	device_t			 hostb, parent;
919 	bhnd_attach_type		 attach_type;
920 	uint32_t			 dflags;
921 
922 	parent = device_get_parent(dev);
923 	hostb = bhnd_bus_find_hostb_device(parent);
924 	attach_type = bhnd_get_attach_type(dev);
925 
926 	for (entry = table; !BHND_DEVICE_IS_END(entry); entry =
927 	    (const struct bhnd_device *) ((const char *) entry + entry_size))
928 	{
929 		/* match core info */
930 		if (!bhnd_device_matches(dev, &entry->core))
931 			continue;
932 
933 		/* match device flags */
934 		dflags = entry->device_flags;
935 
936 		/* hostb implies BHND_ATTACH_ADAPTER requirement */
937 		if (dflags & BHND_DF_HOSTB)
938 			dflags |= BHND_DF_ADAPTER;
939 
940 		if (dflags & BHND_DF_ADAPTER)
941 			if (attach_type != BHND_ATTACH_ADAPTER)
942 				continue;
943 
944 		if (dflags & BHND_DF_HOSTB)
945 			if (dev != hostb)
946 				continue;
947 
948 		if (dflags & BHND_DF_SOC)
949 			if (attach_type != BHND_ATTACH_NATIVE)
950 				continue;
951 
952 		/* device found */
953 		return (entry);
954 	}
955 
956 	/* not found */
957 	return (NULL);
958 }
959 
960 /**
961  * Scan the device @p table for all quirk flags applicable to @p dev.
962  *
963  * @param dev A bhnd device to match against @p table.
964  * @param table The device table to search.
965  * @param entry_size The @p table entry size, in bytes.
966  *
967  * @return all matching quirk flags.
968  */
969 uint32_t
bhnd_device_quirks(device_t dev,const struct bhnd_device * table,size_t entry_size)970 bhnd_device_quirks(device_t dev, const struct bhnd_device *table,
971     size_t entry_size)
972 {
973 	const struct bhnd_device	*dent;
974 	const struct bhnd_device_quirk	*qent, *qtable;
975 	uint32_t			 quirks;
976 
977 	/* Locate the device entry */
978 	if ((dent = bhnd_device_lookup(dev, table, entry_size)) == NULL)
979 		return (0);
980 
981 	/* Quirks table is optional */
982 	qtable = dent->quirks_table;
983 	if (qtable == NULL)
984 		return (0);
985 
986 	/* Collect matching device quirk entries */
987 	quirks = 0;
988 	for (qent = qtable; !BHND_DEVICE_QUIRK_IS_END(qent); qent++) {
989 		if (bhnd_device_matches(dev, &qent->desc))
990 			quirks |= qent->quirks;
991 	}
992 
993 	return (quirks);
994 }
995 
996 /**
997  * Allocate bhnd(4) resources defined in @p rs from a parent bus.
998  *
999  * @param dev The device requesting ownership of the resources.
1000  * @param rs A standard bus resource specification. This will be updated
1001  * with the allocated resource's RIDs.
1002  * @param res On success, the allocated bhnd resources.
1003  *
1004  * @retval 0 success
1005  * @retval non-zero if allocation of any non-RF_OPTIONAL resource fails,
1006  * 		    all allocated resources will be released and a regular
1007  * 		    unix error code will be returned.
1008  */
1009 int
bhnd_alloc_resources(device_t dev,struct resource_spec * rs,struct bhnd_resource ** res)1010 bhnd_alloc_resources(device_t dev, struct resource_spec *rs,
1011     struct bhnd_resource **res)
1012 {
1013 	/* Initialize output array */
1014 	for (u_int i = 0; rs[i].type != -1; i++)
1015 		res[i] = NULL;
1016 
1017 	for (u_int i = 0; rs[i].type != -1; i++) {
1018 		res[i] = bhnd_alloc_resource_any(dev, rs[i].type, &rs[i].rid,
1019 		    rs[i].flags);
1020 
1021 		/* Clean up all allocations on failure */
1022 		if (res[i] == NULL && !(rs[i].flags & RF_OPTIONAL)) {
1023 			bhnd_release_resources(dev, rs, res);
1024 			return (ENXIO);
1025 		}
1026 	}
1027 
1028 	return (0);
1029 }
1030 
1031 /**
1032  * Release bhnd(4) resources defined in @p rs from a parent bus.
1033  *
1034  * @param dev The device that owns the resources.
1035  * @param rs A standard bus resource specification previously initialized
1036  * by @p bhnd_alloc_resources.
1037  * @param res The bhnd resources to be released.
1038  */
1039 void
bhnd_release_resources(device_t dev,const struct resource_spec * rs,struct bhnd_resource ** res)1040 bhnd_release_resources(device_t dev, const struct resource_spec *rs,
1041     struct bhnd_resource **res)
1042 {
1043 	for (u_int i = 0; rs[i].type != -1; i++) {
1044 		if (res[i] == NULL)
1045 			continue;
1046 
1047 		bhnd_release_resource(dev, rs[i].type, rs[i].rid, res[i]);
1048 		res[i] = NULL;
1049 	}
1050 }
1051 
1052 /**
1053  * Allocate and return a new per-core PMU clock control/status (clkctl)
1054  * instance for @p dev.
1055  *
1056  * @param dev		The bhnd(4) core device mapped by @p r.
1057  * @param pmu_dev	The bhnd(4) PMU device, implmenting the bhnd_pmu_if
1058  *			interface. The caller is responsible for ensuring that
1059  *			this reference remains valid for the lifetime of the
1060  *			returned clkctl instance.
1061  * @param r		A resource mapping the core's clock control register
1062  * 			(see BHND_CLK_CTL_ST). The caller is responsible for
1063  *			ensuring that this resource remains valid for the
1064  *			lifetime of the returned clkctl instance.
1065  * @param offset	The offset to the clock control register within @p r.
1066  * @param max_latency	The PMU's maximum state transition latency in
1067  *			microseconds; this upper bound will be used to busy-wait
1068  *			on PMU state transitions.
1069  *
1070  * @retval non-NULL	success
1071  * @retval NULL		if allocation fails.
1072  *
1073  */
1074 struct bhnd_core_clkctl *
bhnd_alloc_core_clkctl(device_t dev,device_t pmu_dev,struct bhnd_resource * r,bus_size_t offset,u_int max_latency)1075 bhnd_alloc_core_clkctl(device_t dev, device_t pmu_dev, struct bhnd_resource *r,
1076     bus_size_t offset, u_int max_latency)
1077 {
1078 	struct bhnd_core_clkctl	*clkctl;
1079 
1080 	clkctl = malloc(sizeof(*clkctl), M_BHND, M_ZERO | M_NOWAIT);
1081 	if (clkctl == NULL)
1082 		return (NULL);
1083 
1084 	clkctl->cc_dev = dev;
1085 	clkctl->cc_pmu_dev = pmu_dev;
1086 	clkctl->cc_res = r;
1087 	clkctl->cc_res_offset = offset;
1088 	clkctl->cc_max_latency = max_latency;
1089 	clkctl->cc_quirks = bhnd_device_quirks(dev, bhnd_clkctl_devices,
1090 	    sizeof(bhnd_clkctl_devices[0]));
1091 
1092 	BHND_CLKCTL_LOCK_INIT(clkctl);
1093 
1094 	return (clkctl);
1095 }
1096 
1097 /**
1098  * Free a clkctl instance previously allocated via bhnd_alloc_core_clkctl().
1099  *
1100  * @param clkctl	The clkctl instance to be freed.
1101  */
1102 void
bhnd_free_core_clkctl(struct bhnd_core_clkctl * clkctl)1103 bhnd_free_core_clkctl(struct bhnd_core_clkctl *clkctl)
1104 {
1105 	BHND_CLKCTL_LOCK_DESTROY(clkctl);
1106 
1107 	free(clkctl, M_BHND);
1108 }
1109 
1110 /**
1111  * Wait for the per-core clock status to be equal to @p value after
1112  * applying @p mask, timing out after the maximum transition latency is reached.
1113  *
1114  * @param clkctl	Per-core clkctl state to be queryied.
1115  * @param value		Value to wait for.
1116  * @param mask		Mask to apply prior to value comparison.
1117  *
1118  * @retval 0		success
1119  * @retval ETIMEDOUT	if the PMU's maximum transition delay is reached before
1120  *			the clock status matches @p value and @p mask.
1121  */
1122 int
bhnd_core_clkctl_wait(struct bhnd_core_clkctl * clkctl,uint32_t value,uint32_t mask)1123 bhnd_core_clkctl_wait(struct bhnd_core_clkctl *clkctl, uint32_t value,
1124     uint32_t mask)
1125 {
1126 	uint32_t	clkst;
1127 
1128 	BHND_CLKCTL_LOCK_ASSERT(clkctl, MA_OWNED);
1129 
1130 	/* Bitswapped HTAVAIL/ALPAVAIL work-around */
1131 	if (clkctl->cc_quirks & BHND_CLKCTL_QUIRK_CCS0) {
1132 		uint32_t fmask, fval;
1133 
1134 		fmask = mask & ~(BHND_CCS_HTAVAIL | BHND_CCS_ALPAVAIL);
1135 		fval = value & ~(BHND_CCS_HTAVAIL | BHND_CCS_ALPAVAIL);
1136 
1137 		if (mask & BHND_CCS_HTAVAIL)
1138 			fmask |= BHND_CCS0_HTAVAIL;
1139 		if (value & BHND_CCS_HTAVAIL)
1140 			fval |= BHND_CCS0_HTAVAIL;
1141 
1142 		if (mask & BHND_CCS_ALPAVAIL)
1143 			fmask |= BHND_CCS0_ALPAVAIL;
1144 		if (value & BHND_CCS_ALPAVAIL)
1145 			fval |= BHND_CCS0_ALPAVAIL;
1146 
1147 		mask = fmask;
1148 		value = fval;
1149 	}
1150 
1151 	for (u_int i = 0; i < clkctl->cc_max_latency; i += 10) {
1152 		clkst = bhnd_bus_read_4(clkctl->cc_res, clkctl->cc_res_offset);
1153 		if ((clkst & mask) == (value & mask))
1154 			return (0);
1155 
1156 		DELAY(10);
1157 	}
1158 
1159 	device_printf(clkctl->cc_dev, "clkst wait timeout (value=%#x, "
1160 	    "mask=%#x)\n", value, mask);
1161 
1162 	return (ETIMEDOUT);
1163 }
1164 
1165 /**
1166  * Read an NVRAM variable's NUL-terminated string value.
1167  *
1168  * @param 	dev	A bhnd bus child device.
1169  * @param	name	The NVRAM variable name.
1170  * @param[out]	buf	A buffer large enough to hold @p len bytes. On
1171  *			success, the NUL-terminated string value will be
1172  *			written to this buffer. This argment may be NULL if
1173  *			the value is not desired.
1174  * @param	len	The maximum capacity of @p buf.
1175  * @param[out]	rlen	On success, will be set to the actual size of
1176  *			the requested value (including NUL termination). This
1177  *			argment may be NULL if the size is not desired.
1178  *
1179  * @retval 0		success
1180  * @retval ENOENT	The requested variable was not found.
1181  * @retval ENODEV	No valid NVRAM source could be found.
1182  * @retval ENOMEM	If @p buf is non-NULL and a buffer of @p len is too
1183  *			small to hold the requested value.
1184  * @retval EFTYPE	If the variable data cannot be coerced to a valid
1185  *			string representation.
1186  * @retval ERANGE	If value coercion would overflow @p type.
1187  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1188  *			error code will be returned.
1189  */
1190 int
bhnd_nvram_getvar_str(device_t dev,const char * name,char * buf,size_t len,size_t * rlen)1191 bhnd_nvram_getvar_str(device_t dev, const char *name, char *buf, size_t len,
1192     size_t *rlen)
1193 {
1194 	size_t	larg;
1195 	int	error;
1196 
1197 	larg = len;
1198 	error = bhnd_nvram_getvar(dev, name, buf, &larg,
1199 	    BHND_NVRAM_TYPE_STRING);
1200 	if (rlen != NULL)
1201 		*rlen = larg;
1202 
1203 	return (error);
1204 }
1205 
1206 /**
1207  * Read an NVRAM variable's unsigned integer value.
1208  *
1209  * @param 		dev	A bhnd bus child device.
1210  * @param		name	The NVRAM variable name.
1211  * @param[out]		value	On success, the requested value will be written
1212  *				to this pointer.
1213  * @param		width	The output integer type width (1, 2, or
1214  *				4 bytes).
1215  *
1216  * @retval 0		success
1217  * @retval ENOENT	The requested variable was not found.
1218  * @retval ENODEV	No valid NVRAM source could be found.
1219  * @retval EFTYPE	If the variable data cannot be coerced to a
1220  *			a valid unsigned integer representation.
1221  * @retval ERANGE	If value coercion would overflow (or underflow) an
1222  *			unsigned representation of the given @p width.
1223  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1224  *			error code will be returned.
1225  */
1226 int
bhnd_nvram_getvar_uint(device_t dev,const char * name,void * value,int width)1227 bhnd_nvram_getvar_uint(device_t dev, const char *name, void *value, int width)
1228 {
1229 	bhnd_nvram_type	type;
1230 	size_t		len;
1231 
1232 	switch (width) {
1233 	case 1:
1234 		type = BHND_NVRAM_TYPE_UINT8;
1235 		break;
1236 	case 2:
1237 		type = BHND_NVRAM_TYPE_UINT16;
1238 		break;
1239 	case 4:
1240 		type = BHND_NVRAM_TYPE_UINT32;
1241 		break;
1242 	default:
1243 		device_printf(dev, "unsupported NVRAM integer width: %d\n",
1244 		    width);
1245 		return (EINVAL);
1246 	}
1247 
1248 	len = width;
1249 	return (bhnd_nvram_getvar(dev, name, value, &len, type));
1250 }
1251 
1252 /**
1253  * Read an NVRAM variable's unsigned 8-bit integer value.
1254  *
1255  * @param 		dev	A bhnd bus child device.
1256  * @param		name	The NVRAM variable name.
1257  * @param[out]		value	On success, the requested value will be written
1258  *				to this pointer.
1259  *
1260  * @retval 0		success
1261  * @retval ENOENT	The requested variable was not found.
1262  * @retval ENODEV	No valid NVRAM source could be found.
1263  * @retval EFTYPE	If the variable data cannot be coerced to a
1264  *			a valid unsigned integer representation.
1265  * @retval ERANGE	If value coercion would overflow (or underflow) uint8_t.
1266  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1267  *			error code will be returned.
1268  */
1269 int
bhnd_nvram_getvar_uint8(device_t dev,const char * name,uint8_t * value)1270 bhnd_nvram_getvar_uint8(device_t dev, const char *name, uint8_t *value)
1271 {
1272 	return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value)));
1273 }
1274 
1275 /**
1276  * Read an NVRAM variable's unsigned 16-bit integer value.
1277  *
1278  * @param 		dev	A bhnd bus child device.
1279  * @param		name	The NVRAM variable name.
1280  * @param[out]		value	On success, the requested value will be written
1281  *				to this pointer.
1282  *
1283  * @retval 0		success
1284  * @retval ENOENT	The requested variable was not found.
1285  * @retval ENODEV	No valid NVRAM source could be found.
1286  * @retval EFTYPE	If the variable data cannot be coerced to a
1287  *			a valid unsigned integer representation.
1288  * @retval ERANGE	If value coercion would overflow (or underflow)
1289  *			uint16_t.
1290  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1291  *			error code will be returned.
1292  */
1293 int
bhnd_nvram_getvar_uint16(device_t dev,const char * name,uint16_t * value)1294 bhnd_nvram_getvar_uint16(device_t dev, const char *name, uint16_t *value)
1295 {
1296 	return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value)));
1297 }
1298 
1299 /**
1300  * Read an NVRAM variable's unsigned 32-bit integer value.
1301  *
1302  * @param 		dev	A bhnd bus child device.
1303  * @param		name	The NVRAM variable name.
1304  * @param[out]		value	On success, the requested value will be written
1305  *				to this pointer.
1306  *
1307  * @retval 0		success
1308  * @retval ENOENT	The requested variable was not found.
1309  * @retval ENODEV	No valid NVRAM source could be found.
1310  * @retval EFTYPE	If the variable data cannot be coerced to a
1311  *			a valid unsigned integer representation.
1312  * @retval ERANGE	If value coercion would overflow (or underflow)
1313  *			uint32_t.
1314  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1315  *			error code will be returned.
1316  */
1317 int
bhnd_nvram_getvar_uint32(device_t dev,const char * name,uint32_t * value)1318 bhnd_nvram_getvar_uint32(device_t dev, const char *name, uint32_t *value)
1319 {
1320 	return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value)));
1321 }
1322 
1323 /**
1324  * Read an NVRAM variable's signed integer value.
1325  *
1326  * @param 		dev	A bhnd bus child device.
1327  * @param		name	The NVRAM variable name.
1328  * @param[out]		value	On success, the requested value will be written
1329  *				to this pointer.
1330  * @param		width	The output integer type width (1, 2, or
1331  *				4 bytes).
1332  *
1333  * @retval 0		success
1334  * @retval ENOENT	The requested variable was not found.
1335  * @retval ENODEV	No valid NVRAM source could be found.
1336  * @retval EFTYPE	If the variable data cannot be coerced to a
1337  *			a valid integer representation.
1338  * @retval ERANGE	If value coercion would overflow (or underflow) an
1339  *			signed representation of the given @p width.
1340  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1341  *			error code will be returned.
1342  */
1343 int
bhnd_nvram_getvar_int(device_t dev,const char * name,void * value,int width)1344 bhnd_nvram_getvar_int(device_t dev, const char *name, void *value, int width)
1345 {
1346 	bhnd_nvram_type	type;
1347 	size_t		len;
1348 
1349 	switch (width) {
1350 	case 1:
1351 		type = BHND_NVRAM_TYPE_INT8;
1352 		break;
1353 	case 2:
1354 		type = BHND_NVRAM_TYPE_INT16;
1355 		break;
1356 	case 4:
1357 		type = BHND_NVRAM_TYPE_INT32;
1358 		break;
1359 	default:
1360 		device_printf(dev, "unsupported NVRAM integer width: %d\n",
1361 		    width);
1362 		return (EINVAL);
1363 	}
1364 
1365 	len = width;
1366 	return (bhnd_nvram_getvar(dev, name, value, &len, type));
1367 }
1368 
1369 /**
1370  * Read an NVRAM variable's signed 8-bit integer value.
1371  *
1372  * @param 		dev	A bhnd bus child device.
1373  * @param		name	The NVRAM variable name.
1374  * @param[out]		value	On success, the requested value will be written
1375  *				to this pointer.
1376  *
1377  * @retval 0		success
1378  * @retval ENOENT	The requested variable was not found.
1379  * @retval ENODEV	No valid NVRAM source could be found.
1380  * @retval EFTYPE	If the variable data cannot be coerced to a
1381  *			a valid integer representation.
1382  * @retval ERANGE	If value coercion would overflow (or underflow) int8_t.
1383  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1384  *			error code will be returned.
1385  */
1386 int
bhnd_nvram_getvar_int8(device_t dev,const char * name,int8_t * value)1387 bhnd_nvram_getvar_int8(device_t dev, const char *name, int8_t *value)
1388 {
1389 	return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value)));
1390 }
1391 
1392 /**
1393  * Read an NVRAM variable's signed 16-bit integer value.
1394  *
1395  * @param 		dev	A bhnd bus child device.
1396  * @param		name	The NVRAM variable name.
1397  * @param[out]		value	On success, the requested value will be written
1398  *				to this pointer.
1399  *
1400  * @retval 0		success
1401  * @retval ENOENT	The requested variable was not found.
1402  * @retval ENODEV	No valid NVRAM source could be found.
1403  * @retval EFTYPE	If the variable data cannot be coerced to a
1404  *			a valid integer representation.
1405  * @retval ERANGE	If value coercion would overflow (or underflow)
1406  *			int16_t.
1407  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1408  *			error code will be returned.
1409  */
1410 int
bhnd_nvram_getvar_int16(device_t dev,const char * name,int16_t * value)1411 bhnd_nvram_getvar_int16(device_t dev, const char *name, int16_t *value)
1412 {
1413 	return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value)));
1414 }
1415 
1416 /**
1417  * Read an NVRAM variable's signed 32-bit integer value.
1418  *
1419  * @param 		dev	A bhnd bus child device.
1420  * @param		name	The NVRAM variable name.
1421  * @param[out]		value	On success, the requested value will be written
1422  *				to this pointer.
1423  *
1424  * @retval 0		success
1425  * @retval ENOENT	The requested variable was not found.
1426  * @retval ENODEV	No valid NVRAM source could be found.
1427  * @retval EFTYPE	If the variable data cannot be coerced to a
1428  *			a valid integer representation.
1429  * @retval ERANGE	If value coercion would overflow (or underflow)
1430  *			int32_t.
1431  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1432  *			error code will be returned.
1433  */
1434 int
bhnd_nvram_getvar_int32(device_t dev,const char * name,int32_t * value)1435 bhnd_nvram_getvar_int32(device_t dev, const char *name, int32_t *value)
1436 {
1437 	return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value)));
1438 }
1439 
1440 /**
1441  * Read an NVRAM variable's array value.
1442  *
1443  * @param 		dev	A bhnd bus child device.
1444  * @param		name	The NVRAM variable name.
1445  * @param[out]		buf	A buffer large enough to hold @p size bytes.
1446  *				On success, the requested value will be written
1447  *				to this buffer.
1448  * @param[in,out]	size	The required number of bytes to write to
1449  *				@p buf.
1450  * @param		type	The desired array element data representation.
1451  *
1452  * @retval 0		success
1453  * @retval ENOENT	The requested variable was not found.
1454  * @retval ENODEV	No valid NVRAM source could be found.
1455  * @retval ENXIO	If less than @p size bytes are available.
1456  * @retval ENOMEM	If a buffer of @p size is too small to hold the
1457  *			requested value.
1458  * @retval EFTYPE	If the variable data cannot be coerced to a
1459  *			a valid instance of @p type.
1460  * @retval ERANGE	If value coercion would overflow (or underflow) a
1461  *			representation of @p type.
1462  * @retval non-zero	If reading @p name otherwise fails, a regular unix
1463  *			error code will be returned.
1464  */
1465 int
bhnd_nvram_getvar_array(device_t dev,const char * name,void * buf,size_t size,bhnd_nvram_type type)1466 bhnd_nvram_getvar_array(device_t dev, const char *name, void *buf, size_t size,
1467     bhnd_nvram_type type)
1468 {
1469 	size_t	nbytes;
1470 	int	error;
1471 
1472 	/* Attempt read */
1473 	nbytes = size;
1474 	if ((error = bhnd_nvram_getvar(dev, name, buf, &nbytes, type)))
1475 		return (error);
1476 
1477 	/* Verify that the expected number of bytes were fetched */
1478 	if (nbytes < size)
1479 		return (ENXIO);
1480 
1481 	return (0);
1482 }
1483 
1484 /**
1485  * Initialize a service provider registry.
1486  *
1487  * @param bsr		The service registry to initialize.
1488  *
1489  * @retval 0            success
1490  * @retval non-zero     if an error occurs initializing the service registry,
1491  *                      a regular unix error code will be returned.
1492 
1493  */
1494 int
bhnd_service_registry_init(struct bhnd_service_registry * bsr)1495 bhnd_service_registry_init(struct bhnd_service_registry *bsr)
1496 {
1497 	STAILQ_INIT(&bsr->entries);
1498 	mtx_init(&bsr->lock, "bhnd_service_registry lock", NULL, MTX_DEF);
1499 
1500 	return (0);
1501 }
1502 
1503 /**
1504  * Release all resources held by @p bsr.
1505  *
1506  * @param bsr		A service registry instance previously successfully
1507  *			initialized via bhnd_service_registry_init().
1508  *
1509  * @retval 0		success
1510  * @retval EBUSY	if active references to service providers registered
1511  *			with @p bsr exist.
1512  */
1513 int
bhnd_service_registry_fini(struct bhnd_service_registry * bsr)1514 bhnd_service_registry_fini(struct bhnd_service_registry *bsr)
1515 {
1516 	struct bhnd_service_entry *entry, *enext;
1517 
1518 	/* Remove everthing we can */
1519 	mtx_lock(&bsr->lock);
1520 	STAILQ_FOREACH_SAFE(entry, &bsr->entries, link, enext) {
1521 		if (entry->refs > 0)
1522 			continue;
1523 
1524 		STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry, link);
1525 		free(entry, M_BHND);
1526 	}
1527 
1528 	if (!STAILQ_EMPTY(&bsr->entries)) {
1529 		mtx_unlock(&bsr->lock);
1530 		return (EBUSY);
1531 	}
1532 	mtx_unlock(&bsr->lock);
1533 
1534 	mtx_destroy(&bsr->lock);
1535 	return (0);
1536 }
1537 
1538 /**
1539  * Register a @p provider for the given @p service.
1540  *
1541  * @param bsr		Service registry to be modified.
1542  * @param provider	Service provider to register.
1543  * @param service	Service for which @p provider will be registered.
1544  * @param flags		Service provider flags (see BHND_SPF_*).
1545  *
1546  * @retval 0		success
1547  * @retval EEXIST	if an entry for @p service already exists.
1548  * @retval EINVAL	if @p service is BHND_SERVICE_ANY.
1549  * @retval non-zero	if registering @p provider otherwise fails, a regular
1550  *			unix error code will be returned.
1551  */
1552 int
bhnd_service_registry_add(struct bhnd_service_registry * bsr,device_t provider,bhnd_service_t service,uint32_t flags)1553 bhnd_service_registry_add(struct bhnd_service_registry *bsr, device_t provider,
1554     bhnd_service_t service, uint32_t flags)
1555 {
1556 	struct bhnd_service_entry *entry;
1557 
1558 	if (service == BHND_SERVICE_ANY)
1559 		return (EINVAL);
1560 
1561 	mtx_lock(&bsr->lock);
1562 
1563 	/* Is a service provider already registered? */
1564 	STAILQ_FOREACH(entry, &bsr->entries, link) {
1565 		if (entry->service == service) {
1566 			mtx_unlock(&bsr->lock);
1567 			return (EEXIST);
1568 		}
1569 	}
1570 
1571 	/* Initialize and insert our new entry */
1572 	entry = malloc(sizeof(*entry), M_BHND, M_NOWAIT);
1573 	if (entry == NULL) {
1574 		mtx_unlock(&bsr->lock);
1575 		return (ENOMEM);
1576 	}
1577 
1578 	entry->provider = provider;
1579 	entry->service = service;
1580 	entry->flags = flags;
1581 	refcount_init(&entry->refs, 0);
1582 
1583 	STAILQ_INSERT_HEAD(&bsr->entries, entry, link);
1584 
1585 	mtx_unlock(&bsr->lock);
1586 	return (0);
1587 }
1588 
1589 /**
1590  * Free an unreferenced registry entry.
1591  *
1592  * @param entry	The entry to be deallocated.
1593  */
1594 static void
bhnd_service_registry_free_entry(struct bhnd_service_entry * entry)1595 bhnd_service_registry_free_entry(struct bhnd_service_entry *entry)
1596 {
1597 	KASSERT(entry->refs == 0, ("provider has active references"));
1598 	free(entry, M_BHND);
1599 }
1600 
1601 /**
1602  * Attempt to remove the @p service provider registration for @p provider.
1603  *
1604  * @param bsr		The service registry to be modified.
1605  * @param provider	The service provider to be deregistered.
1606  * @param service	The service for which @p provider will be deregistered,
1607  *			or BHND_SERVICE_ANY to remove all service
1608  *			registrations for @p provider.
1609  *
1610  * @retval 0		success
1611  * @retval EBUSY	if active references to @p provider exist; see
1612  *			bhnd_service_registry_retain() and
1613  *			bhnd_service_registry_release().
1614  */
1615 int
bhnd_service_registry_remove(struct bhnd_service_registry * bsr,device_t provider,bhnd_service_t service)1616 bhnd_service_registry_remove(struct bhnd_service_registry *bsr,
1617     device_t provider, bhnd_service_t service)
1618 {
1619 	struct bhnd_service_entry *entry, *enext;
1620 
1621 	mtx_lock(&bsr->lock);
1622 
1623 #define	BHND_PROV_MATCH(_e)	\
1624 	((_e)->provider == provider &&	\
1625 	 (service == BHND_SERVICE_ANY || (_e)->service == service))
1626 
1627 	/* Validate matching provider entries before making any
1628 	 * modifications */
1629 	STAILQ_FOREACH(entry, &bsr->entries, link) {
1630 		/* Skip non-matching entries */
1631 		if (!BHND_PROV_MATCH(entry))
1632 			continue;
1633 
1634 		/* Entry is in use? */
1635 		if (entry->refs > 0) {
1636 			mtx_unlock(&bsr->lock);
1637 			return (EBUSY);
1638 		}
1639 	}
1640 
1641 	/* We can now safely remove matching entries */
1642 	STAILQ_FOREACH_SAFE(entry, &bsr->entries, link, enext) {
1643 		/* Skip non-matching entries */
1644 		if (!BHND_PROV_MATCH(entry))
1645 			continue;
1646 
1647 		/* Remove from list */
1648 		STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry, link);
1649 
1650 		/* Free provider entry */
1651 		bhnd_service_registry_free_entry(entry);
1652 	}
1653 #undef	BHND_PROV_MATCH
1654 
1655 	mtx_unlock(&bsr->lock);
1656 	return (0);
1657 }
1658 
1659 /**
1660  * Retain and return a reference to a registered @p service provider, if any.
1661  *
1662  * @param bsr		The service registry to be queried.
1663  * @param service	The service for which a provider should be returned.
1664  *
1665  * On success, the caller assumes ownership the returned provider, and
1666  * is responsible for releasing this reference via
1667  * bhnd_service_registry_release().
1668  *
1669  * @retval device_t	success
1670  * @retval NULL		if no provider is registered for @p service.
1671  */
1672 device_t
bhnd_service_registry_retain(struct bhnd_service_registry * bsr,bhnd_service_t service)1673 bhnd_service_registry_retain(struct bhnd_service_registry *bsr,
1674     bhnd_service_t service)
1675 {
1676 	struct bhnd_service_entry *entry;
1677 
1678 	mtx_lock(&bsr->lock);
1679 	STAILQ_FOREACH(entry, &bsr->entries, link) {
1680 		if (entry->service != service)
1681 			continue;
1682 
1683 		/* With a live refcount, entry is gauranteed to remain alive
1684 		 * after we release our lock */
1685 		refcount_acquire(&entry->refs);
1686 
1687 		mtx_unlock(&bsr->lock);
1688 		return (entry->provider);
1689 	}
1690 	mtx_unlock(&bsr->lock);
1691 
1692 	/* Not found */
1693 	return (NULL);
1694 }
1695 
1696 /**
1697  * Release a reference to a service provider previously returned by
1698  * bhnd_service_registry_retain().
1699  *
1700  * If this is the last reference to an inherited service provider registration
1701  * (see BHND_SPF_INHERITED), the registration will also be removed, and
1702  * true will be returned.
1703  *
1704  * @param bsr		The service registry from which @p provider
1705  *			was returned.
1706  * @param provider	The provider to be released.
1707  * @param service	The service for which @p provider was previously
1708  *			retained.
1709  * @retval true		The inherited service provider registration was removed;
1710  *			the caller should release its own reference to the
1711  *			provider.
1712  * @retval false	The service provider was not inherited, or active
1713  *			references to the provider remain.
1714  *
1715  * @see BHND_SPF_INHERITED
1716  */
1717 bool
bhnd_service_registry_release(struct bhnd_service_registry * bsr,device_t provider,bhnd_service_t service)1718 bhnd_service_registry_release(struct bhnd_service_registry *bsr,
1719     device_t provider, bhnd_service_t service)
1720 {
1721 	struct bhnd_service_entry *entry;
1722 
1723 	/* Exclusive lock, as we need to prevent any new references to the
1724 	 * entry from being taken if it's to be removed */
1725 	mtx_lock(&bsr->lock);
1726 	STAILQ_FOREACH(entry, &bsr->entries, link) {
1727 		bool removed;
1728 
1729 		if (entry->provider != provider)
1730 			continue;
1731 
1732 		if (entry->service != service)
1733 			continue;
1734 
1735 		if (refcount_release(&entry->refs) &&
1736 		    (entry->flags & BHND_SPF_INHERITED))
1737 		{
1738 			/* If an inherited entry is no longer actively
1739 			 * referenced, remove the local registration and inform
1740 			 * the caller. */
1741 			STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry,
1742 			    link);
1743 			bhnd_service_registry_free_entry(entry);
1744 			removed = true;
1745 		} else {
1746 			removed = false;
1747 		}
1748 
1749 		mtx_unlock(&bsr->lock);
1750 		return (removed);
1751 	}
1752 
1753 	/* Caller owns a reference, but no such provider is registered? */
1754 	panic("invalid service provider reference");
1755 }
1756 
1757 /**
1758  * Using the bhnd(4) bus-level core information and a custom core name,
1759  * populate @p dev's device description.
1760  *
1761  * @param dev A bhnd-bus attached device.
1762  * @param dev_name The core's name (e.g. "SDIO Device Core").
1763  */
1764 void
bhnd_set_custom_core_desc(device_t dev,const char * dev_name)1765 bhnd_set_custom_core_desc(device_t dev, const char *dev_name)
1766 {
1767 	const char *vendor_name;
1768 	char *desc;
1769 
1770 	vendor_name = bhnd_get_vendor_name(dev);
1771 	asprintf(&desc, M_BHND, "%s %s, rev %hhu", vendor_name, dev_name,
1772 	    bhnd_get_hwrev(dev));
1773 
1774 	if (desc != NULL) {
1775 		device_set_desc_copy(dev, desc);
1776 		free(desc, M_BHND);
1777 	} else {
1778 		device_set_desc(dev, dev_name);
1779 	}
1780 }
1781 
1782 /**
1783  * Using the bhnd(4) bus-level core information, populate @p dev's device
1784  * description.
1785  *
1786  * @param dev A bhnd-bus attached device.
1787  */
1788 void
bhnd_set_default_core_desc(device_t dev)1789 bhnd_set_default_core_desc(device_t dev)
1790 {
1791 	bhnd_set_custom_core_desc(dev, bhnd_get_device_name(dev));
1792 }
1793 
1794 /**
1795  * Using the bhnd @p chip_id, populate the bhnd(4) bus @p dev's device
1796  * description.
1797  *
1798  * @param dev A bhnd-bus attached device.
1799  * @param chip_id The chip identification.
1800  */
1801 void
bhnd_set_default_bus_desc(device_t dev,const struct bhnd_chipid * chip_id)1802 bhnd_set_default_bus_desc(device_t dev, const struct bhnd_chipid *chip_id)
1803 {
1804 	const char	*bus_name;
1805 	char		*desc;
1806 	char		 chip_name[BHND_CHIPID_MAX_NAMELEN];
1807 
1808 	/* Determine chip type's bus name */
1809 	switch (chip_id->chip_type) {
1810 	case BHND_CHIPTYPE_SIBA:
1811 		bus_name = "SIBA bus";
1812 		break;
1813 	case BHND_CHIPTYPE_BCMA:
1814 	case BHND_CHIPTYPE_BCMA_ALT:
1815 		bus_name = "BCMA bus";
1816 		break;
1817 	case BHND_CHIPTYPE_UBUS:
1818 		bus_name = "UBUS bus";
1819 		break;
1820 	default:
1821 		bus_name = "Unknown Type";
1822 		break;
1823 	}
1824 
1825 	/* Format chip name */
1826 	bhnd_format_chip_id(chip_name, sizeof(chip_name),
1827 	     chip_id->chip_id);
1828 
1829 	/* Format and set device description */
1830 	asprintf(&desc, M_BHND, "%s %s", chip_name, bus_name);
1831 	if (desc != NULL) {
1832 		device_set_desc_copy(dev, desc);
1833 		free(desc, M_BHND);
1834 	} else {
1835 		device_set_desc(dev, bus_name);
1836 	}
1837 
1838 }
1839 
1840 /**
1841  * Helper function for implementing BHND_BUS_REGISTER_PROVIDER().
1842  *
1843  * This implementation delegates the request to the BHND_BUS_REGISTER_PROVIDER()
1844  * method on the parent of @p dev. If no parent exists, the implementation
1845  * will return an error.
1846  */
1847 int
bhnd_bus_generic_register_provider(device_t dev,device_t child,device_t provider,bhnd_service_t service)1848 bhnd_bus_generic_register_provider(device_t dev, device_t child,
1849     device_t provider, bhnd_service_t service)
1850 {
1851 	device_t parent = device_get_parent(dev);
1852 
1853 	if (parent != NULL) {
1854 		return (BHND_BUS_REGISTER_PROVIDER(parent, child,
1855 		    provider, service));
1856 	}
1857 
1858 	return (ENXIO);
1859 }
1860 
1861 /**
1862  * Helper function for implementing BHND_BUS_DEREGISTER_PROVIDER().
1863  *
1864  * This implementation delegates the request to the
1865  * BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent
1866  * exists, the implementation will panic.
1867  */
1868 int
bhnd_bus_generic_deregister_provider(device_t dev,device_t child,device_t provider,bhnd_service_t service)1869 bhnd_bus_generic_deregister_provider(device_t dev, device_t child,
1870     device_t provider, bhnd_service_t service)
1871 {
1872 	device_t parent = device_get_parent(dev);
1873 
1874 	if (parent != NULL) {
1875 		return (BHND_BUS_DEREGISTER_PROVIDER(parent, child,
1876 		    provider, service));
1877 	}
1878 
1879 	panic("missing BHND_BUS_DEREGISTER_PROVIDER()");
1880 }
1881 
1882 /**
1883  * Helper function for implementing BHND_BUS_RETAIN_PROVIDER().
1884  *
1885  * This implementation delegates the request to the
1886  * BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent
1887  * exists, the implementation will return NULL.
1888  */
1889 device_t
bhnd_bus_generic_retain_provider(device_t dev,device_t child,bhnd_service_t service)1890 bhnd_bus_generic_retain_provider(device_t dev, device_t child,
1891     bhnd_service_t service)
1892 {
1893 	device_t parent = device_get_parent(dev);
1894 
1895 	if (parent != NULL) {
1896 		return (BHND_BUS_RETAIN_PROVIDER(parent, child,
1897 		    service));
1898 	}
1899 
1900 	return (NULL);
1901 }
1902 
1903 /**
1904  * Helper function for implementing BHND_BUS_RELEASE_PROVIDER().
1905  *
1906  * This implementation delegates the request to the
1907  * BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent
1908  * exists, the implementation will panic.
1909  */
1910 void
bhnd_bus_generic_release_provider(device_t dev,device_t child,device_t provider,bhnd_service_t service)1911 bhnd_bus_generic_release_provider(device_t dev, device_t child,
1912     device_t provider, bhnd_service_t service)
1913 {
1914 	device_t parent = device_get_parent(dev);
1915 
1916 	if (parent != NULL) {
1917 		return (BHND_BUS_RELEASE_PROVIDER(parent, child,
1918 		    provider, service));
1919 	}
1920 
1921 	panic("missing BHND_BUS_RELEASE_PROVIDER()");
1922 }
1923 
1924 /**
1925  * Helper function for implementing BHND_BUS_REGISTER_PROVIDER().
1926  *
1927  * This implementation uses the bhnd_service_registry_add() function to
1928  * do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find
1929  * a suitable service registry to edit.
1930  */
1931 int
bhnd_bus_generic_sr_register_provider(device_t dev,device_t child,device_t provider,bhnd_service_t service)1932 bhnd_bus_generic_sr_register_provider(device_t dev, device_t child,
1933     device_t provider, bhnd_service_t service)
1934 {
1935 	struct bhnd_service_registry *bsr;
1936 
1937 	bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child);
1938 
1939 	KASSERT(bsr != NULL, ("NULL service registry"));
1940 
1941 	return (bhnd_service_registry_add(bsr, provider, service, 0));
1942 }
1943 
1944 /**
1945  * Helper function for implementing BHND_BUS_DEREGISTER_PROVIDER().
1946  *
1947  * This implementation uses the bhnd_service_registry_remove() function to
1948  * do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find
1949  * a suitable service registry to edit.
1950  */
1951 int
bhnd_bus_generic_sr_deregister_provider(device_t dev,device_t child,device_t provider,bhnd_service_t service)1952 bhnd_bus_generic_sr_deregister_provider(device_t dev, device_t child,
1953     device_t provider, bhnd_service_t service)
1954 {
1955 	struct bhnd_service_registry *bsr;
1956 
1957 	bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child);
1958 
1959 	KASSERT(bsr != NULL, ("NULL service registry"));
1960 
1961 	return (bhnd_service_registry_remove(bsr, provider, service));
1962 }
1963 
1964 /**
1965  * Helper function for implementing BHND_BUS_RETAIN_PROVIDER().
1966  *
1967  * This implementation uses the bhnd_service_registry_retain() function to
1968  * do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find
1969  * a suitable service registry.
1970  *
1971  * If a local provider for the service is not available, and a parent device is
1972  * available, this implementation will attempt to fetch and locally register
1973  * a service provider reference from the parent of @p dev.
1974  */
1975 device_t
bhnd_bus_generic_sr_retain_provider(device_t dev,device_t child,bhnd_service_t service)1976 bhnd_bus_generic_sr_retain_provider(device_t dev, device_t child,
1977     bhnd_service_t service)
1978 {
1979 	struct bhnd_service_registry	*bsr;
1980 	device_t			 parent, provider;
1981 	int				 error;
1982 
1983 	bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child);
1984 	KASSERT(bsr != NULL, ("NULL service registry"));
1985 
1986 	/*
1987 	 * Attempt to fetch a service provider reference from either the local
1988 	 * service registry, or if not found, from our parent.
1989 	 *
1990 	 * If we fetch a provider from our parent, we register the provider
1991 	 * with the local service registry to prevent conflicting local
1992 	 * registrations from being added.
1993 	 */
1994 	while (1) {
1995 		/* Check the local service registry first */
1996 		provider = bhnd_service_registry_retain(bsr, service);
1997 		if (provider != NULL)
1998 			return (provider);
1999 
2000 		/* Otherwise, try to delegate to our parent (if any) */
2001 		if ((parent = device_get_parent(dev)) == NULL)
2002 			return (NULL);
2003 
2004 		provider = BHND_BUS_RETAIN_PROVIDER(parent, dev, service);
2005 		if (provider == NULL)
2006 			return (NULL);
2007 
2008 		/* Register the inherited service registration with the local
2009 		 * registry */
2010 		error = bhnd_service_registry_add(bsr, provider, service,
2011 		    BHND_SPF_INHERITED);
2012 		if (error) {
2013 			BHND_BUS_RELEASE_PROVIDER(parent, dev, provider,
2014 			    service);
2015 			if (error == EEXIST) {
2016 				/* A valid service provider was registered
2017 				 * concurrently; retry fetching from the local
2018 				 * registry */
2019 				continue;
2020 			}
2021 
2022 			device_printf(dev, "failed to register service "
2023 			    "provider: %d\n", error);
2024 			return (NULL);
2025 		}
2026 	}
2027 }
2028 
2029 /**
2030  * Helper function for implementing BHND_BUS_RELEASE_PROVIDER().
2031  *
2032  * This implementation uses the bhnd_service_registry_release() function to
2033  * do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find
2034  * a suitable service registry.
2035  */
2036 void
bhnd_bus_generic_sr_release_provider(device_t dev,device_t child,device_t provider,bhnd_service_t service)2037 bhnd_bus_generic_sr_release_provider(device_t dev, device_t child,
2038     device_t provider, bhnd_service_t service)
2039 {
2040 	struct bhnd_service_registry	*bsr;
2041 
2042 	bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child);
2043 	KASSERT(bsr != NULL, ("NULL service registry"));
2044 
2045 	/* Release the provider reference; if the refcount hits zero on an
2046 	 * inherited reference, true will be returned, and we need to drop
2047 	 * our own bus reference to the provider */
2048 	if (!bhnd_service_registry_release(bsr, provider, service))
2049 		return;
2050 
2051 	/* Drop our reference to the borrowed provider */
2052 	BHND_BUS_RELEASE_PROVIDER(device_get_parent(dev), dev, provider,
2053 	    service);
2054 }
2055 
2056 /**
2057  * Helper function for implementing BHND_BUS_IS_HW_DISABLED().
2058  *
2059  * If a parent device is available, this implementation delegates the
2060  * request to the BHND_BUS_IS_HW_DISABLED() method on the parent of @p dev.
2061  *
2062  * If no parent device is available (i.e. on a the bus root), the hardware
2063  * is assumed to be usable and false is returned.
2064  */
2065 bool
bhnd_bus_generic_is_hw_disabled(device_t dev,device_t child)2066 bhnd_bus_generic_is_hw_disabled(device_t dev, device_t child)
2067 {
2068 	if (device_get_parent(dev) != NULL)
2069 		return (BHND_BUS_IS_HW_DISABLED(device_get_parent(dev), child));
2070 
2071 	return (false);
2072 }
2073 
2074 /**
2075  * Helper function for implementing BHND_BUS_GET_CHIPID().
2076  *
2077  * This implementation delegates the request to the BHND_BUS_GET_CHIPID()
2078  * method on the parent of @p dev. If no parent exists, the implementation
2079  * will panic.
2080  */
2081 const struct bhnd_chipid *
bhnd_bus_generic_get_chipid(device_t dev,device_t child)2082 bhnd_bus_generic_get_chipid(device_t dev, device_t child)
2083 {
2084 	if (device_get_parent(dev) != NULL)
2085 		return (BHND_BUS_GET_CHIPID(device_get_parent(dev), child));
2086 
2087 	panic("missing BHND_BUS_GET_CHIPID()");
2088 }
2089 
2090 /**
2091  * Helper function for implementing BHND_BUS_GET_DMA_TRANSLATION().
2092  *
2093  * If a parent device is available, this implementation delegates the
2094  * request to the BHND_BUS_GET_DMA_TRANSLATION() method on the parent of @p dev.
2095  *
2096  * If no parent device is available, this implementation will panic.
2097  */
2098 int
bhnd_bus_generic_get_dma_translation(device_t dev,device_t child,u_int width,uint32_t flags,bus_dma_tag_t * dmat,struct bhnd_dma_translation * translation)2099 bhnd_bus_generic_get_dma_translation(device_t dev, device_t child, u_int width,
2100     uint32_t flags, bus_dma_tag_t *dmat,
2101     struct bhnd_dma_translation *translation)
2102 {
2103 	if (device_get_parent(dev) != NULL) {
2104 		return (BHND_BUS_GET_DMA_TRANSLATION(device_get_parent(dev),
2105 		    child, width, flags, dmat, translation));
2106 	}
2107 
2108 	panic("missing BHND_BUS_GET_DMA_TRANSLATION()");
2109 }
2110 
2111 /* nvram board_info population macros for bhnd_bus_generic_read_board_info() */
2112 #define	BHND_GV(_dest, _name)	\
2113 	bhnd_nvram_getvar_uint(child, BHND_NVAR_ ## _name, &_dest,	\
2114 	    sizeof(_dest))
2115 
2116 #define	REQ_BHND_GV(_dest, _name)		do {			\
2117 	if ((error = BHND_GV(_dest, _name))) {				\
2118 		device_printf(dev,					\
2119 		    "error reading " __STRING(_name) ": %d\n", error);	\
2120 		return (error);						\
2121 	}								\
2122 } while(0)
2123 
2124 #define	OPT_BHND_GV(_dest, _name, _default)	do {			\
2125 	if ((error = BHND_GV(_dest, _name))) {				\
2126 		if (error != ENOENT) {					\
2127 			device_printf(dev,				\
2128 			    "error reading "				\
2129 			       __STRING(_name) ": %d\n", error);	\
2130 			return (error);					\
2131 		}							\
2132 		_dest = _default;					\
2133 	}								\
2134 } while(0)
2135 
2136 /**
2137  * Helper function for implementing BHND_BUS_READ_BOARDINFO().
2138  *
2139  * This implementation populates @p info with information from NVRAM,
2140  * defaulting board_vendor and board_type fields to 0 if the
2141  * requested variables cannot be found.
2142  *
2143  * This behavior is correct for most SoCs, but must be overridden on
2144  * bridged (PCI, PCMCIA, etc) devices to produce a complete bhnd_board_info
2145  * result.
2146  */
2147 int
bhnd_bus_generic_read_board_info(device_t dev,device_t child,struct bhnd_board_info * info)2148 bhnd_bus_generic_read_board_info(device_t dev, device_t child,
2149     struct bhnd_board_info *info)
2150 {
2151 	int	error;
2152 
2153 	OPT_BHND_GV(info->board_vendor,	BOARDVENDOR,	0);
2154 	OPT_BHND_GV(info->board_type,	BOARDTYPE,	0);	/* srom >= 2 */
2155 	OPT_BHND_GV(info->board_devid,	DEVID,		0);	/* srom >= 8 */
2156 	REQ_BHND_GV(info->board_rev,	BOARDREV);
2157 	OPT_BHND_GV(info->board_srom_rev,SROMREV,	0);	/* missing in
2158 								   some SoC
2159 								   NVRAM */
2160 	REQ_BHND_GV(info->board_flags,	BOARDFLAGS);
2161 	OPT_BHND_GV(info->board_flags2,	BOARDFLAGS2,	0);	/* srom >= 4 */
2162 	OPT_BHND_GV(info->board_flags3,	BOARDFLAGS3,	0);	/* srom >= 11 */
2163 
2164 	return (0);
2165 }
2166 
2167 #undef	BHND_GV
2168 #undef	BHND_GV_REQ
2169 #undef	BHND_GV_OPT
2170 
2171 /**
2172  * Helper function for implementing BHND_BUS_GET_NVRAM_VAR().
2173  *
2174  * This implementation searches @p dev for a usable NVRAM child device.
2175  *
2176  * If no usable child device is found on @p dev, the request is delegated to
2177  * the BHND_BUS_GET_NVRAM_VAR() method on the parent of @p dev.
2178  */
2179 int
bhnd_bus_generic_get_nvram_var(device_t dev,device_t child,const char * name,void * buf,size_t * size,bhnd_nvram_type type)2180 bhnd_bus_generic_get_nvram_var(device_t dev, device_t child, const char *name,
2181     void *buf, size_t *size, bhnd_nvram_type type)
2182 {
2183 	device_t	nvram;
2184 	device_t	parent;
2185 
2186 	bus_topo_assert();
2187 
2188 	/* Look for a directly-attached NVRAM child */
2189 	if ((nvram = device_find_child(dev, "bhnd_nvram", -1)) != NULL)
2190 		return BHND_NVRAM_GETVAR(nvram, name, buf, size, type);
2191 
2192 	/* Try to delegate to parent */
2193 	if ((parent = device_get_parent(dev)) == NULL)
2194 		return (ENODEV);
2195 
2196 	return (BHND_BUS_GET_NVRAM_VAR(device_get_parent(dev), child,
2197 	    name, buf, size, type));
2198 }
2199 
2200 /**
2201  * Helper function for implementing BHND_BUS_ALLOC_RESOURCE().
2202  *
2203  * This implementation of BHND_BUS_ALLOC_RESOURCE() delegates allocation
2204  * of the underlying resource to BUS_ALLOC_RESOURCE(), and activation
2205  * to @p dev's BHND_BUS_ACTIVATE_RESOURCE().
2206  */
2207 struct bhnd_resource *
bhnd_bus_generic_alloc_resource(device_t dev,device_t child,int type,int * rid,rman_res_t start,rman_res_t end,rman_res_t count,u_int flags)2208 bhnd_bus_generic_alloc_resource(device_t dev, device_t child, int type,
2209 	int *rid, rman_res_t start, rman_res_t end, rman_res_t count,
2210 	u_int flags)
2211 {
2212 	struct bhnd_resource	*br;
2213 	struct resource		*res;
2214 	int			 error;
2215 
2216 	br = NULL;
2217 	res = NULL;
2218 
2219 	/* Allocate the real bus resource (without activating it) */
2220 	res = BUS_ALLOC_RESOURCE(dev, child, type, rid, start, end, count,
2221 	    (flags & ~RF_ACTIVE));
2222 	if (res == NULL)
2223 		return (NULL);
2224 
2225 	/* Allocate our bhnd resource wrapper. */
2226 	br = malloc(sizeof(struct bhnd_resource), M_BHND, M_NOWAIT);
2227 	if (br == NULL)
2228 		goto failed;
2229 
2230 	br->direct = false;
2231 	br->res = res;
2232 
2233 	/* Attempt activation */
2234 	if (flags & RF_ACTIVE) {
2235 		error = BHND_BUS_ACTIVATE_RESOURCE(dev, child, type, *rid, br);
2236 		if (error)
2237 			goto failed;
2238 	}
2239 
2240 	return (br);
2241 
2242 failed:
2243 	if (res != NULL)
2244 		BUS_RELEASE_RESOURCE(dev, child, res);
2245 
2246 	free(br, M_BHND);
2247 	return (NULL);
2248 }
2249 
2250 /**
2251  * Helper function for implementing BHND_BUS_RELEASE_RESOURCE().
2252  *
2253  * This implementation of BHND_BUS_RELEASE_RESOURCE() delegates release of
2254  * the backing resource to BUS_RELEASE_RESOURCE().
2255  */
2256 int
bhnd_bus_generic_release_resource(device_t dev,device_t child,int type,int rid,struct bhnd_resource * r)2257 bhnd_bus_generic_release_resource(device_t dev, device_t child, int type,
2258     int rid, struct bhnd_resource *r)
2259 {
2260 	int error;
2261 
2262 	if ((error = BUS_RELEASE_RESOURCE(dev, child, r->res)))
2263 		return (error);
2264 
2265 	free(r, M_BHND);
2266 	return (0);
2267 }
2268 
2269 /**
2270  * Helper function for implementing BHND_BUS_ACTIVATE_RESOURCE().
2271  *
2272  * This implementation of BHND_BUS_ACTIVATE_RESOURCE() first calls the
2273  * BHND_BUS_ACTIVATE_RESOURCE() method of the parent of @p dev.
2274  *
2275  * If this fails, and if @p dev is the direct parent of @p child, standard
2276  * resource activation is attempted via bus_activate_resource(). This enables
2277  * direct use of the bhnd(4) resource APIs on devices that may not be attached
2278  * to a parent bhnd bus or bridge.
2279  */
2280 int
bhnd_bus_generic_activate_resource(device_t dev,device_t child,int type,int rid,struct bhnd_resource * r)2281 bhnd_bus_generic_activate_resource(device_t dev, device_t child, int type,
2282     int rid, struct bhnd_resource *r)
2283 {
2284 	int	error;
2285 	bool	passthrough;
2286 
2287 	passthrough = (device_get_parent(child) != dev);
2288 
2289 	/* Try to delegate to the parent */
2290 	if (device_get_parent(dev) != NULL) {
2291 		error = BHND_BUS_ACTIVATE_RESOURCE(device_get_parent(dev),
2292 		    child, type, rid, r);
2293 	} else {
2294 		error = ENODEV;
2295 	}
2296 
2297 	/* If bhnd(4) activation has failed and we're the child's direct
2298 	 * parent, try falling back on standard resource activation.
2299 	 */
2300 	if (error && !passthrough) {
2301 		error = bus_activate_resource(child, type, rid, r->res);
2302 		if (!error)
2303 			r->direct = true;
2304 	}
2305 
2306 	return (error);
2307 }
2308 
2309 /**
2310  * Helper function for implementing BHND_BUS_DEACTIVATE_RESOURCE().
2311  *
2312  * This implementation of BHND_BUS_ACTIVATE_RESOURCE() simply calls the
2313  * BHND_BUS_ACTIVATE_RESOURCE() method of the parent of @p dev.
2314  */
2315 int
bhnd_bus_generic_deactivate_resource(device_t dev,device_t child,int type,int rid,struct bhnd_resource * r)2316 bhnd_bus_generic_deactivate_resource(device_t dev, device_t child,
2317     int type, int rid, struct bhnd_resource *r)
2318 {
2319 	if (device_get_parent(dev) != NULL)
2320 		return (BHND_BUS_DEACTIVATE_RESOURCE(device_get_parent(dev),
2321 		    child, type, rid, r));
2322 
2323 	return (EINVAL);
2324 }
2325 
2326 /**
2327  * Helper function for implementing BHND_BUS_GET_INTR_DOMAIN().
2328  *
2329  * This implementation simply returns the address of nearest bhnd(4) bus,
2330  * which may be @p dev; this behavior may be incompatible with FDT/OFW targets.
2331  */
2332 uintptr_t
bhnd_bus_generic_get_intr_domain(device_t dev,device_t child,bool self)2333 bhnd_bus_generic_get_intr_domain(device_t dev, device_t child, bool self)
2334 {
2335 	return ((uintptr_t)dev);
2336 }
2337