d/freebsd-skq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
67cf61ca22
freebsd-skq/sys/dev/bhnd/bhnd_subr.c
landonf 2e486532df bhnd: Implement bhnd(4) platform device registration. 
Add bhnd(4) API for explicitly registering BHND platform devices (ChipCommon,
PMU, NVRAM, etc) with the bus, rather than walking the newbus hierarchy to
discover platform devices. These devices are now also refcounted; attempting
to deregister an actively used platform device will return EBUSY.

This resolves a lock ordering incompatibility with bwn(4)'s firmware loading
threads; previously it was necessary to acquire Giant to protect newbus access
when locating and querying the NVRAM device.

Approved by:	adrian (mentor)
Sponsored by:	The FreeBSD Foundation
Differential Revision:	https://reviews.freebsd.org/D12392
2017-09-27 19:44:23 +00:00

2320 lines
64 KiB
C
Raw Blame History

/*-
* Copyright (c) 2015-2016 Landon Fuller <landon@landonf.org>
* Copyright (c) 2017 The FreeBSD Foundation
* All rights reserved.
*
* Portions of this software were developed by Landon Fuller
* under sponsorship from the FreeBSD Foundation.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer,
* without modification.
* 2. Redistributions in binary form must reproduce at minimum a disclaimer
* similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
* redistribution must be conditioned upon including a substantially
* similar Disclaimer requirement for further binary redistribution.
*
* NO WARRANTY
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
* AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
* THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
* OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
* IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
* THE POSSIBILITY OF SUCH DAMAGES.
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include <sys/param.h>
#include <sys/bus.h>
#include <sys/refcount.h>
#include <sys/systm.h>
#include <machine/bus.h>
#include <sys/rman.h>
#include <machine/resource.h>
#include <dev/bhnd/siba/sibareg.h>
#include <dev/bhnd/cores/chipc/chipcreg.h>
#include "nvram/bhnd_nvram.h"
#include "bhnd_chipc_if.h"
#include "bhnd_nvram_if.h"
#include "bhnd_nvram_map.h"
#include "bhndreg.h"
#include "bhndvar.h"
#include "bhnd_private.h"
static void bhnd_service_registry_free_entry(
struct bhnd_service_entry *entry);
static int compare_ascending_probe_order(const void *lhs, const void *rhs);
static int compare_descending_probe_order(const void *lhs,
const void *rhs);
/* BHND core device description table. */
static const struct bhnd_core_desc {
uint16_t vendor;
uint16_t device;
bhnd_devclass_t class;
const char *desc;
} bhnd_core_descs[] = {
#define BHND_CDESC(_mfg, _cid, _cls, _desc) \
{ BHND_MFGID_ ## _mfg, BHND_COREID_ ## _cid, \
BHND_DEVCLASS_ ## _cls, _desc }
BHND_CDESC(BCM, CC, CC, "ChipCommon I/O Controller"),
BHND_CDESC(BCM, ILINE20, OTHER, "iLine20 HPNA"),
BHND_CDESC(BCM, SRAM, RAM, "SRAM"),
BHND_CDESC(BCM, SDRAM, RAM, "SDRAM"),
BHND_CDESC(BCM, PCI, PCI, "PCI Bridge"),
BHND_CDESC(BCM, MIPS, CPU, "BMIPS CPU"),
BHND_CDESC(BCM, ENET, ENET_MAC, "Fast Ethernet MAC"),
BHND_CDESC(BCM, CODEC, OTHER, "V.90 Modem Codec"),
BHND_CDESC(BCM, USB, USB_DUAL, "USB 1.1 Device/Host Controller"),
BHND_CDESC(BCM, ADSL, OTHER, "ADSL Core"),
BHND_CDESC(BCM, ILINE100, OTHER, "iLine100 HPNA"),
BHND_CDESC(BCM, IPSEC, OTHER, "IPsec Accelerator"),
BHND_CDESC(BCM, UTOPIA, OTHER, "UTOPIA ATM Core"),
BHND_CDESC(BCM, PCMCIA, PCCARD, "PCMCIA Bridge"),
BHND_CDESC(BCM, SOCRAM, RAM, "Internal Memory"),
BHND_CDESC(BCM, MEMC, MEMC, "MEMC SDRAM Controller"),
BHND_CDESC(BCM, OFDM, OTHER, "OFDM PHY"),
BHND_CDESC(BCM, EXTIF, OTHER, "External Interface"),
BHND_CDESC(BCM, D11, WLAN, "802.11 MAC/PHY/Radio"),
BHND_CDESC(BCM, APHY, WLAN_PHY, "802.11a PHY"),
BHND_CDESC(BCM, BPHY, WLAN_PHY, "802.11b PHY"),
BHND_CDESC(BCM, GPHY, WLAN_PHY, "802.11g PHY"),
BHND_CDESC(BCM, MIPS33, CPU, "BMIPS33 CPU"),
BHND_CDESC(BCM, USB11H, USB_HOST, "USB 1.1 Host Controller"),
BHND_CDESC(BCM, USB11D, USB_DEV, "USB 1.1 Device Controller"),
BHND_CDESC(BCM, USB20H, USB_HOST, "USB 2.0 Host Controller"),
BHND_CDESC(BCM, USB20D, USB_DEV, "USB 2.0 Device Controller"),
BHND_CDESC(BCM, SDIOH, OTHER, "SDIO Host Controller"),
BHND_CDESC(BCM, ROBO, OTHER, "RoboSwitch"),
BHND_CDESC(BCM, ATA100, OTHER, "Parallel ATA Controller"),
BHND_CDESC(BCM, SATAXOR, OTHER, "SATA DMA/XOR Controller"),
BHND_CDESC(BCM, GIGETH, ENET_MAC, "Gigabit Ethernet MAC"),
BHND_CDESC(BCM, PCIE, PCIE, "PCIe Bridge"),
BHND_CDESC(BCM, NPHY, WLAN_PHY, "802.11n 2x2 PHY"),
BHND_CDESC(BCM, SRAMC, MEMC, "SRAM Controller"),
BHND_CDESC(BCM, MINIMAC, OTHER, "MINI MAC/PHY"),
BHND_CDESC(BCM, ARM11, CPU, "ARM1176 CPU"),
BHND_CDESC(BCM, ARM7S, CPU, "ARM7TDMI-S CPU"),
BHND_CDESC(BCM, LPPHY, WLAN_PHY, "802.11a/b/g PHY"),
BHND_CDESC(BCM, PMU, PMU, "PMU"),
BHND_CDESC(BCM, SSNPHY, WLAN_PHY, "802.11n Single-Stream PHY"),
BHND_CDESC(BCM, SDIOD, OTHER, "SDIO Device Core"),
BHND_CDESC(BCM, ARMCM3, CPU, "ARM Cortex-M3 CPU"),
BHND_CDESC(BCM, HTPHY, WLAN_PHY, "802.11n 4x4 PHY"),
BHND_CDESC(MIPS,MIPS74K, CPU, "MIPS74k CPU"),
BHND_CDESC(BCM, GMAC, ENET_MAC, "Gigabit MAC core"),
BHND_CDESC(BCM, DMEMC, MEMC, "DDR1/DDR2 Memory Controller"),
BHND_CDESC(BCM, PCIERC, OTHER, "PCIe Root Complex"),
BHND_CDESC(BCM, OCP, SOC_BRIDGE, "OCP to OCP Bridge"),
BHND_CDESC(BCM, SC, OTHER, "Shared Common Core"),
BHND_CDESC(BCM, AHB, SOC_BRIDGE, "OCP to AHB Bridge"),
BHND_CDESC(BCM, SPIH, OTHER, "SPI Host Controller"),
BHND_CDESC(BCM, I2S, OTHER, "I2S Digital Audio Interface"),
BHND_CDESC(BCM, DMEMS, MEMC, "SDR/DDR1 Memory Controller"),
BHND_CDESC(BCM, UBUS_SHIM, OTHER, "BCM6362/UBUS WLAN SHIM"),
BHND_CDESC(BCM, PCIE2, PCIE, "PCIe Bridge (Gen2)"),
BHND_CDESC(ARM, APB_BRIDGE, SOC_BRIDGE, "BP135 AMBA3 AXI to APB Bridge"),
BHND_CDESC(ARM, PL301, SOC_ROUTER, "PL301 AMBA3 Interconnect"),
BHND_CDESC(ARM, EROM, EROM, "PL366 Device Enumeration ROM"),
BHND_CDESC(ARM, OOB_ROUTER, OTHER, "PL367 OOB Interrupt Router"),
BHND_CDESC(ARM, AXI_UNMAPPED, OTHER, "Unmapped Address Ranges"),
BHND_CDESC(BCM, 4706_CC, CC, "ChipCommon I/O Controller"),
BHND_CDESC(BCM, NS_PCIE2, PCIE, "PCIe Bridge (Gen2)"),
BHND_CDESC(BCM, NS_DMA, OTHER, "DMA engine"),
BHND_CDESC(BCM, NS_SDIO, OTHER, "SDIO 3.0 Host Controller"),
BHND_CDESC(BCM, NS_USB20H, USB_HOST, "USB 2.0 Host Controller"),
BHND_CDESC(BCM, NS_USB30H, USB_HOST, "USB 3.0 Host Controller"),
BHND_CDESC(BCM, NS_A9JTAG, OTHER, "ARM Cortex A9 JTAG Interface"),
BHND_CDESC(BCM, NS_DDR23_MEMC, MEMC, "Denali DDR2/DD3 Memory Controller"),
BHND_CDESC(BCM, NS_ROM, NVRAM, "System ROM"),
BHND_CDESC(BCM, NS_NAND, NVRAM, "NAND Flash Controller"),
BHND_CDESC(BCM, NS_QSPI, NVRAM, "QSPI Flash Controller"),
BHND_CDESC(BCM, NS_CC_B, CC_B, "ChipCommon B Auxiliary I/O Controller"),
BHND_CDESC(BCM, 4706_SOCRAM, RAM, "Internal Memory"),
BHND_CDESC(BCM, IHOST_ARMCA9, CPU, "ARM Cortex A9 CPU"),
BHND_CDESC(BCM, 4706_GMAC_CMN, ENET, "Gigabit MAC (Common)"),
BHND_CDESC(BCM, 4706_GMAC, ENET_MAC, "Gigabit MAC"),
BHND_CDESC(BCM, AMEMC, MEMC, "Denali DDR1/DDR2 Memory Controller"),
#undef BHND_CDESC
/* Derived from inspection of the BCM4331 cores that provide PrimeCell
* IDs. Due to lack of documentation, the surmised device name/purpose
* provided here may be incorrect. */
{ BHND_MFGID_ARM, BHND_PRIMEID_EROM, BHND_DEVCLASS_OTHER,
"PL364 Device Enumeration ROM" },
{ BHND_MFGID_ARM, BHND_PRIMEID_SWRAP, BHND_DEVCLASS_OTHER,
"PL368 Device Management Interface" },
{ BHND_MFGID_ARM, BHND_PRIMEID_MWRAP, BHND_DEVCLASS_OTHER,
"PL369 Device Management Interface" },
{ 0, 0, 0, NULL }
};
/**
* Return the name for a given JEP106 manufacturer ID.
*
* @param vendor A JEP106 Manufacturer ID, including the non-standard ARM 4-bit
* JEP106 continuation code.
*/
const char *
bhnd_vendor_name(uint16_t vendor)
{
switch (vendor) {
case BHND_MFGID_ARM:
return "ARM";
case BHND_MFGID_BCM:
return "Broadcom";
case BHND_MFGID_MIPS:
return "MIPS";
default:
return "unknown";
}
}
/**
* Return the name of a port type.
*/
const char *
bhnd_port_type_name(bhnd_port_type port_type)
{
switch (port_type) {
case BHND_PORT_DEVICE:
return ("device");
case BHND_PORT_BRIDGE:
return ("bridge");
case BHND_PORT_AGENT:
return ("agent");
default:
return "unknown";
}
}
/**
* Return the name of an NVRAM source.
*/
const char *
bhnd_nvram_src_name(bhnd_nvram_src nvram_src)
{
switch (nvram_src) {
case BHND_NVRAM_SRC_FLASH:
return ("flash");
case BHND_NVRAM_SRC_OTP:
return ("OTP");
case BHND_NVRAM_SRC_SPROM:
return ("SPROM");
case BHND_NVRAM_SRC_UNKNOWN:
return ("none");
default:
return ("unknown");
}
}
static const struct bhnd_core_desc *
bhnd_find_core_desc(uint16_t vendor, uint16_t device)
{
for (u_int i = 0; bhnd_core_descs[i].desc != NULL; i++) {
if (bhnd_core_descs[i].vendor != vendor)
continue;
if (bhnd_core_descs[i].device != device)
continue;
return (&bhnd_core_descs[i]);
}
return (NULL);
}
/**
* Return a human-readable name for a BHND core.
*
* @param vendor The core designer's JEDEC-106 Manufacturer ID
* @param device The core identifier.
*/
const char *
bhnd_find_core_name(uint16_t vendor, uint16_t device)
{
const struct bhnd_core_desc *desc;
if ((desc = bhnd_find_core_desc(vendor, device)) == NULL)
return ("unknown");
return desc->desc;
}
/**
* Return the device class for a BHND core.
*
* @param vendor The core designer's JEDEC-106 Manufacturer ID
* @param device The core identifier.
*/
bhnd_devclass_t
bhnd_find_core_class(uint16_t vendor, uint16_t device)
{
const struct bhnd_core_desc *desc;
if ((desc = bhnd_find_core_desc(vendor, device)) == NULL)
return (BHND_DEVCLASS_OTHER);
return desc->class;
}
/**
* Return a human-readable name for a BHND core.
*
* @param ci The core's info record.
*/
const char *
bhnd_core_name(const struct bhnd_core_info *ci)
{
return bhnd_find_core_name(ci->vendor, ci->device);
}
/**
* Return the device class for a BHND core.
*
* @param ci The core's info record.
*/
bhnd_devclass_t
bhnd_core_class(const struct bhnd_core_info *ci)
{
return bhnd_find_core_class(ci->vendor, ci->device);
}
/**
* Write a human readable name representation of the given
* BHND_CHIPID_* constant to @p buffer.
*
* @param buffer Output buffer, or NULL to compute the required size.
* @param size Capacity of @p buffer, in bytes.
* @param chip_id Chip ID to be formatted.
*
* @return Returns the required number of bytes on success, or a negative
* integer on failure. No more than @p size-1 characters be written, with
* the @p size'th set to '\0'.
*
* @sa BHND_CHIPID_MAX_NAMELEN
*/
int
bhnd_format_chip_id(char *buffer, size_t size, uint16_t chip_id)
{
/* All hex formatted IDs are within the range of 0x4000-0x9C3F (40000-1) */
if (chip_id >= 0x4000 && chip_id <= 0x9C3F)
return (snprintf(buffer, size, "BCM%hX", chip_id));
else
return (snprintf(buffer, size, "BCM%hu", chip_id));
}
/**
* Initialize a core info record with data from from a bhnd-attached @p dev.
*
* @param dev A bhnd device.
* @param core The record to be initialized.
*/
struct bhnd_core_info
bhnd_get_core_info(device_t dev) {
return (struct bhnd_core_info) {
.vendor = bhnd_get_vendor(dev),
.device = bhnd_get_device(dev),
.hwrev = bhnd_get_hwrev(dev),
.core_idx = bhnd_get_core_index(dev),
.unit = bhnd_get_core_unit(dev)
};
}
/**
* Find a @p class child device with @p unit on @p bus.
*
* @param bus The bhnd-compatible bus to be searched.
* @param class The device class to match on.
* @param unit The core unit number; specify -1 to return the first match
* regardless of unit number.
*
* @retval device_t if a matching child device is found.
* @retval NULL if no matching child device is found.
*/
device_t
bhnd_bus_find_child(device_t bus, bhnd_devclass_t class, int unit)
{
struct bhnd_core_match md = {
BHND_MATCH_CORE_CLASS(class),
BHND_MATCH_CORE_UNIT(unit)
};
if (unit == -1)
md.m.match.core_unit = 0;
return bhnd_bus_match_child(bus, &md);
}
/**
* Find the first child device on @p bus that matches @p desc.
*
* @param bus The bhnd-compatible bus to be searched.
* @param desc A match descriptor.
*
* @retval device_t if a matching child device is found.
* @retval NULL if no matching child device is found.
*/
device_t
bhnd_bus_match_child(device_t bus, const struct bhnd_core_match *desc)
{
device_t *devlistp;
device_t match;
int devcnt;
int error;
error = device_get_children(bus, &devlistp, &devcnt);
if (error != 0)
return (NULL);
match = NULL;
for (int i = 0; i < devcnt; i++) {
struct bhnd_core_info ci = bhnd_get_core_info(devlistp[i]);
if (bhnd_core_matches(&ci, desc)) {
match = devlistp[i];
goto done;
}
}
done:
free(devlistp, M_TEMP);
return match;
}
/**
* Retrieve an ordered list of all device instances currently connected to
* @p bus, returning a pointer to the array in @p devlistp and the count
* in @p ndevs.
*
* The memory allocated for the table must be freed via
* bhnd_bus_free_children().
*
* @param bus The bhnd-compatible bus to be queried.
* @param[out] devlist The array of devices.
* @param[out] devcount The number of devices in @p devlistp
* @param order The order in which devices will be returned
* in @p devlist.
*
* @retval 0 success
* @retval non-zero if an error occurs, a regular unix error code will
* be returned.
*/
int
bhnd_bus_get_children(device_t bus, device_t **devlist, int *devcount,
bhnd_device_order order)
{
int error;
/* Fetch device array */
if ((error = device_get_children(bus, devlist, devcount)))
return (error);
/* Perform requested sorting */
if ((error = bhnd_sort_devices(*devlist, *devcount, order))) {
bhnd_bus_free_children(*devlist);
return (error);
}
return (0);
}
/**
* Free any memory allocated in a previous call to bhnd_bus_get_children().
*
* @param devlist The device array returned by bhnd_bus_get_children().
*/
void
bhnd_bus_free_children(device_t *devlist)
{
free(devlist, M_TEMP);
}
/**
* Perform in-place sorting of an array of bhnd device instances.
*
* @param devlist An array of bhnd devices.
* @param devcount The number of devices in @p devs.
* @param order The sort order to be used.
*/
int
bhnd_sort_devices(device_t *devlist, size_t devcount, bhnd_device_order order)
{
int (*compare)(const void *, const void *);
switch (order) {
case BHND_DEVICE_ORDER_ATTACH:
compare = compare_ascending_probe_order;
break;
case BHND_DEVICE_ORDER_DETACH:
compare = compare_descending_probe_order;
break;
default:
printf("unknown sort order: %d\n", order);
return (EINVAL);
}
qsort(devlist, devcount, sizeof(*devlist), compare);
return (0);
}
/*
* Ascending comparison of bhnd device's probe order.
*/
static int
compare_ascending_probe_order(const void *lhs, const void *rhs)
{
device_t ldev, rdev;
int lorder, rorder;
ldev = (*(const device_t *) lhs);
rdev = (*(const device_t *) rhs);
lorder = BHND_BUS_GET_PROBE_ORDER(device_get_parent(ldev), ldev);
rorder = BHND_BUS_GET_PROBE_ORDER(device_get_parent(rdev), rdev);
if (lorder < rorder) {
return (-1);
} else if (lorder > rorder) {
return (1);
} else {
return (0);
}
}
/*
* Descending comparison of bhnd device's probe order.
*/
static int
compare_descending_probe_order(const void *lhs, const void *rhs)
{
return (compare_ascending_probe_order(rhs, lhs));
}
/**
* Call device_probe_and_attach() for each of the bhnd bus device's
* children, in bhnd attach order.
*
* @param bus The bhnd-compatible bus for which all children should be probed
* and attached.
*/
int
bhnd_bus_probe_children(device_t bus)
{
device_t *devs;
int ndevs;
int error;
/* Fetch children in attach order */
error = bhnd_bus_get_children(bus, &devs, &ndevs,
BHND_DEVICE_ORDER_ATTACH);
if (error)
return (error);
/* Probe and attach all children */
for (int i = 0; i < ndevs; i++) {
device_t child = devs[i];
device_probe_and_attach(child);
}
bhnd_bus_free_children(devs);
return (0);
}
/**
* Walk up the bhnd device hierarchy to locate the root device
* to which the bhndb bridge is attached.
*
* This can be used from within bhnd host bridge drivers to locate the
* actual upstream host device.
*
* @param dev A bhnd device.
* @param bus_class The expected bus (e.g. "pci") to which the bridge root
* should be attached.
*
* @retval device_t if a matching parent device is found.
* @retval NULL @p dev is not attached via a bhndb bus
* @retval NULL no parent device is attached via @p bus_class.
*/
device_t
bhnd_find_bridge_root(device_t dev, devclass_t bus_class)
{
devclass_t bhndb_class;
device_t parent;
KASSERT(device_get_devclass(device_get_parent(dev)) == bhnd_devclass,
("%s not a bhnd device", device_get_nameunit(dev)));
bhndb_class = devclass_find("bhndb");
/* Walk the device tree until we hit a bridge */
parent = dev;
while ((parent = device_get_parent(parent)) != NULL) {
if (device_get_devclass(parent) == bhndb_class)
break;
}
/* No bridge? */
if (parent == NULL)
return (NULL);
/* Search for a parent attached to the expected bus class */
while ((parent = device_get_parent(parent)) != NULL) {
device_t bus;
bus = device_get_parent(parent);
if (bus != NULL && device_get_devclass(bus) == bus_class)
return (parent);
}
/* Not found */
return (NULL);
}
/**
* Find the first core in @p cores that matches @p desc.
*
* @param cores The table to search.
* @param num_cores The length of @p cores.
* @param desc A match descriptor.
*
* @retval bhnd_core_info if a matching core is found.
* @retval NULL if no matching core is found.
*/
const struct bhnd_core_info *
bhnd_match_core(const struct bhnd_core_info *cores, u_int num_cores,
const struct bhnd_core_match *desc)
{
for (u_int i = 0; i < num_cores; i++) {
if (bhnd_core_matches(&cores[i], desc))
return &cores[i];
}
return (NULL);
}
/**
* Find the first core in @p cores with the given @p class.
*
* @param cores The table to search.
* @param num_cores The length of @p cores.
* @param desc A match descriptor.
*
* @retval bhnd_core_info if a matching core is found.
* @retval NULL if no matching core is found.
*/
const struct bhnd_core_info *
bhnd_find_core(const struct bhnd_core_info *cores, u_int num_cores,
bhnd_devclass_t class)
{
struct bhnd_core_match md = {
BHND_MATCH_CORE_CLASS(class)
};
return bhnd_match_core(cores, num_cores, &md);
}
/**
* Create an equality match descriptor for @p core.
*
* @param core The core info to be matched on.
* @param desc On return, will be populated with a match descriptor for @p core.
*/
struct bhnd_core_match
bhnd_core_get_match_desc(const struct bhnd_core_info *core)
{
return ((struct bhnd_core_match) {
BHND_MATCH_CORE_VENDOR(core->vendor),
BHND_MATCH_CORE_ID(core->device),
BHND_MATCH_CORE_REV(HWREV_EQ(core->hwrev)),
BHND_MATCH_CORE_CLASS(bhnd_core_class(core)),
BHND_MATCH_CORE_IDX(core->core_idx),
BHND_MATCH_CORE_UNIT(core->unit)
});
}
/**
* Return true if the @p lhs is equal to @p rhs
*
* @param lhs The first bhnd core descriptor to compare.
* @param rhs The second bhnd core descriptor to compare.
*
* @retval true if @p lhs is equal to @p rhs
* @retval false if @p lhs is not equal to @p rhs
*/
bool
bhnd_cores_equal(const struct bhnd_core_info *lhs,
const struct bhnd_core_info *rhs)
{
struct bhnd_core_match md;
/* Use an equality match descriptor to perform the comparison */
md = bhnd_core_get_match_desc(rhs);
return (bhnd_core_matches(lhs, &md));
}
/**
* Return true if the @p core matches @p desc.
*
* @param core A bhnd core descriptor.
* @param desc A match descriptor to compare against @p core.
*
* @retval true if @p core matches @p match
* @retval false if @p core does not match @p match.
*/
bool
bhnd_core_matches(const struct bhnd_core_info *core,
const struct bhnd_core_match *desc)
{
if (desc->m.match.core_vendor && desc->core_vendor != core->vendor)
return (false);
if (desc->m.match.core_id && desc->core_id != core->device)
return (false);
if (desc->m.match.core_unit && desc->core_unit != core->unit)
return (false);
if (desc->m.match.core_rev &&
!bhnd_hwrev_matches(core->hwrev, &desc->core_rev))
return (false);
if (desc->m.match.core_idx && desc->core_idx != core->core_idx)
return (false);
if (desc->m.match.core_class &&
desc->core_class != bhnd_core_class(core))
return (false);
return true;
}
/**
* Return true if the @p chip matches @p desc.
*
* @param chip A bhnd chip identifier.
* @param desc A match descriptor to compare against @p chip.
*
* @retval true if @p chip matches @p match
* @retval false if @p chip does not match @p match.
*/
bool
bhnd_chip_matches(const struct bhnd_chipid *chip,
const struct bhnd_chip_match *desc)
{
if (desc->m.match.chip_id && chip->chip_id != desc->chip_id)
return (false);
if (desc->m.match.chip_pkg && chip->chip_pkg != desc->chip_pkg)
return (false);
if (desc->m.match.chip_rev &&
!bhnd_hwrev_matches(chip->chip_rev, &desc->chip_rev))
return (false);
return (true);
}
/**
* Return true if the @p board matches @p desc.
*
* @param board The bhnd board info.
* @param desc A match descriptor to compare against @p board.
*
* @retval true if @p chip matches @p match
* @retval false if @p chip does not match @p match.
*/
bool
bhnd_board_matches(const struct bhnd_board_info *board,
const struct bhnd_board_match *desc)
{
if (desc->m.match.board_srom_rev &&
!bhnd_hwrev_matches(board->board_srom_rev, &desc->board_srom_rev))
return (false);
if (desc->m.match.board_vendor &&
board->board_vendor != desc->board_vendor)
return (false);
if (desc->m.match.board_type && board->board_type != desc->board_type)
return (false);
if (desc->m.match.board_rev &&
!bhnd_hwrev_matches(board->board_rev, &desc->board_rev))
return (false);
return (true);
}
/**
* Return true if the @p hwrev matches @p desc.
*
* @param hwrev A bhnd hardware revision.
* @param desc A match descriptor to compare against @p core.
*
* @retval true if @p hwrev matches @p match
* @retval false if @p hwrev does not match @p match.
*/
bool
bhnd_hwrev_matches(uint16_t hwrev, const struct bhnd_hwrev_match *desc)
{
if (desc->start != BHND_HWREV_INVALID &&
desc->start > hwrev)
return false;
if (desc->end != BHND_HWREV_INVALID &&
desc->end < hwrev)
return false;
return true;
}
/**
* Return true if the @p dev matches @p desc.
*
* @param dev A bhnd device.
* @param desc A match descriptor to compare against @p dev.
*
* @retval true if @p dev matches @p match
* @retval false if @p dev does not match @p match.
*/
bool
bhnd_device_matches(device_t dev, const struct bhnd_device_match *desc)
{
struct bhnd_core_info core;
const struct bhnd_chipid *chip;
struct bhnd_board_info board;
device_t parent;
int error;
/* Construct individual match descriptors */
struct bhnd_core_match m_core = { _BHND_CORE_MATCH_COPY(desc) };
struct bhnd_chip_match m_chip = { _BHND_CHIP_MATCH_COPY(desc) };
struct bhnd_board_match m_board = { _BHND_BOARD_MATCH_COPY(desc) };
/* Fetch and match core info */
if (m_core.m.match_flags) {
/* Only applicable to bhnd-attached cores */
parent = device_get_parent(dev);
if (device_get_devclass(parent) != bhnd_devclass) {
device_printf(dev, "attempting to match core "
"attributes against non-core device\n");
return (false);
}
core = bhnd_get_core_info(dev);
if (!bhnd_core_matches(&core, &m_core))
return (false);
}
/* Fetch and match chip info */
if (m_chip.m.match_flags) {
chip = bhnd_get_chipid(dev);
if (!bhnd_chip_matches(chip, &m_chip))
return (false);
}
/* Fetch and match board info.
*
* This is not available until after NVRAM is up; earlier device
* matches should not include board requirements */
if (m_board.m.match_flags) {
if ((error = bhnd_read_board_info(dev, &board))) {
device_printf(dev, "failed to read required board info "
"during device matching: %d\n", error);
return (false);
}
if (!bhnd_board_matches(&board, &m_board))
return (false);
}
/* All matched */
return (true);
}
/**
* Search @p table for an entry matching @p dev.
*
* @param dev A bhnd device to match against @p table.
* @param table The device table to search.
* @param entry_size The @p table entry size, in bytes.
*
* @retval bhnd_device the first matching device, if any.
* @retval NULL if no matching device is found in @p table.
*/
const struct bhnd_device *
bhnd_device_lookup(device_t dev, const struct bhnd_device *table,
size_t entry_size)
{
const struct bhnd_device *entry;
device_t hostb, parent;
bhnd_attach_type attach_type;
uint32_t dflags;
parent = device_get_parent(dev);
hostb = bhnd_bus_find_hostb_device(parent);
attach_type = bhnd_get_attach_type(dev);
for (entry = table; !BHND_DEVICE_IS_END(entry); entry =
(const struct bhnd_device *) ((const char *) entry + entry_size))
{
/* match core info */
if (!bhnd_device_matches(dev, &entry->core))
continue;
/* match device flags */
dflags = entry->device_flags;
/* hostb implies BHND_ATTACH_ADAPTER requirement */
if (dflags & BHND_DF_HOSTB)
dflags |= BHND_DF_ADAPTER;
if (dflags & BHND_DF_ADAPTER)
if (attach_type != BHND_ATTACH_ADAPTER)
continue;
if (dflags & BHND_DF_HOSTB)
if (dev != hostb)
continue;
if (dflags & BHND_DF_SOC)
if (attach_type != BHND_ATTACH_NATIVE)
continue;
/* device found */
return (entry);
}
/* not found */
return (NULL);
}
/**
* Scan the device @p table for all quirk flags applicable to @p dev.
*
* @param dev A bhnd device to match against @p table.
* @param table The device table to search.
*
* @return returns all matching quirk flags.
*/
uint32_t
bhnd_device_quirks(device_t dev, const struct bhnd_device *table,
size_t entry_size)
{
const struct bhnd_device *dent;
const struct bhnd_device_quirk *qent, *qtable;
uint32_t quirks;
/* Locate the device entry */
if ((dent = bhnd_device_lookup(dev, table, entry_size)) == NULL)
return (0);
/* Quirks table is optional */
qtable = dent->quirks_table;
if (qtable == NULL)
return (0);
/* Collect matching device quirk entries */
quirks = 0;
for (qent = qtable; !BHND_DEVICE_QUIRK_IS_END(qent); qent++) {
if (bhnd_device_matches(dev, &qent->desc))
quirks |= qent->quirks;
}
return (quirks);
}
/**
* Allocate bhnd(4) resources defined in @p rs from a parent bus.
*
* @param dev The device requesting ownership of the resources.
* @param rs A standard bus resource specification. This will be updated
* with the allocated resource's RIDs.
* @param res On success, the allocated bhnd resources.
*
* @retval 0 success
* @retval non-zero if allocation of any non-RF_OPTIONAL resource fails,
* all allocated resources will be released and a regular
* unix error code will be returned.
*/
int
bhnd_alloc_resources(device_t dev, struct resource_spec *rs,
struct bhnd_resource **res)
{
/* Initialize output array */
for (u_int i = 0; rs[i].type != -1; i++)
res[i] = NULL;
for (u_int i = 0; rs[i].type != -1; i++) {
res[i] = bhnd_alloc_resource_any(dev, rs[i].type, &rs[i].rid,
rs[i].flags);
/* Clean up all allocations on failure */
if (res[i] == NULL && !(rs[i].flags & RF_OPTIONAL)) {
bhnd_release_resources(dev, rs, res);
return (ENXIO);
}
}
return (0);
}
/**
* Release bhnd(4) resources defined in @p rs from a parent bus.
*
* @param dev The device that owns the resources.
* @param rs A standard bus resource specification previously initialized
* by @p bhnd_alloc_resources.
* @param res The bhnd resources to be released.
*/
void
bhnd_release_resources(device_t dev, const struct resource_spec *rs,
struct bhnd_resource **res)
{
for (u_int i = 0; rs[i].type != -1; i++) {
if (res[i] == NULL)
continue;
bhnd_release_resource(dev, rs[i].type, rs[i].rid, res[i]);
res[i] = NULL;
}
}
/**
* Parse the CHIPC_ID_* fields from the ChipCommon CHIPC_ID
* register, returning its bhnd_chipid representation.
*
* @param idreg The CHIPC_ID register value.
* @param enum_addr The enumeration address to include in the result.
*
* @warning
* On early siba(4) devices, the ChipCommon core does not provide
* a valid CHIPC_ID_NUMCORE field. On these ChipCommon revisions
* (see CHIPC_NCORES_MIN_HWREV()), this function will parse and return
* an invalid `ncores` value.
*/
struct bhnd_chipid
bhnd_parse_chipid(uint32_t idreg, bhnd_addr_t enum_addr)
{
struct bhnd_chipid result;
/* Fetch the basic chip info */
result.chip_id = CHIPC_GET_BITS(idreg, CHIPC_ID_CHIP);
result.chip_pkg = CHIPC_GET_BITS(idreg, CHIPC_ID_PKG);
result.chip_rev = CHIPC_GET_BITS(idreg, CHIPC_ID_REV);
result.chip_type = CHIPC_GET_BITS(idreg, CHIPC_ID_BUS);
result.ncores = CHIPC_GET_BITS(idreg, CHIPC_ID_NUMCORE);
result.enum_addr = enum_addr;
return (result);
}
/**
* Determine the correct core count for a chip identification value that
* may contain an invalid core count.
*
* On some early siba(4) devices (see CHIPC_NCORES_MIN_HWREV()), the ChipCommon
* core does not provide a valid CHIPC_ID_NUMCORE field.
*
* @param cid The chip identification to be queried.
* @param chipc_hwrev The hardware revision of the ChipCommon core from which
* @p cid was parsed.
* @param[out] ncores On success, will be set to the correct core count.
*
* @retval 0 If the core count is already correct, or was mapped to a
* a correct value.
* @retval EINVAL If the core count is incorrect, but the chip was not
* recognized.
*/
int
bhnd_chipid_fixed_ncores(const struct bhnd_chipid *cid, uint16_t chipc_hwrev,
uint8_t *ncores)
{
/* bcma(4), and most siba(4) devices */
if (CHIPC_NCORES_MIN_HWREV(chipc_hwrev)) {
*ncores = cid->ncores;
return (0);
}
/* broken siba(4) chipsets */
switch (cid->chip_id) {
case BHND_CHIPID_BCM4306:
*ncores = 6;
break;
case BHND_CHIPID_BCM4704:
*ncores = 9;
break;
case BHND_CHIPID_BCM5365:
/*
* BCM5365 does support ID_NUMCORE in at least
* some of its revisions, but for unknown
* reasons, Broadcom's drivers always exclude
* the ChipCommon revision (0x5) used by BCM5365
* from the set of revisions supporting
* ID_NUMCORE, and instead supply a fixed value.
*
* Presumably, at least some of these devices
* shipped with a broken ID_NUMCORE value.
*/
*ncores = 7;
break;
default:
return (EINVAL);
}
return (0);
}
/**
* Allocate the resource defined by @p rs via @p dev, use it
* to read the ChipCommon ID register relative to @p chipc_offset,
* then release the resource.
*
* @param dev The device owning @p rs.
* @param rs A resource spec that encompasses the ChipCommon register block.
* @param chipc_offset The offset of the ChipCommon registers within @p rs.
* @param[out] result the chip identification data.
*
* @retval 0 success
* @retval non-zero if the ChipCommon identification data could not be read.
*/
int
bhnd_read_chipid(device_t dev, struct resource_spec *rs,
bus_size_t chipc_offset, struct bhnd_chipid *result)
{
struct resource *res;
bhnd_addr_t enum_addr;
uint32_t reg;
uint8_t chip_type;
int error, rid, rtype;
rid = rs->rid;
rtype = rs->type;
error = 0;
/* Allocate the ChipCommon window resource and fetch the chipid data */
res = bus_alloc_resource_any(dev, rtype, &rid, RF_ACTIVE);
if (res == NULL) {
device_printf(dev,
"failed to allocate bhnd chipc resource\n");
return (ENXIO);
}
/* Fetch the basic chip info */
reg = bus_read_4(res, chipc_offset + CHIPC_ID);
chip_type = CHIPC_GET_BITS(reg, CHIPC_ID_BUS);
/* Fetch the EROMPTR */
if (BHND_CHIPTYPE_HAS_EROM(chip_type)) {
enum_addr = bus_read_4(res, chipc_offset + CHIPC_EROMPTR);
} else if (chip_type == BHND_CHIPTYPE_SIBA) {
/* siba(4) uses the ChipCommon base address as the enumeration
* address */
enum_addr = BHND_DEFAULT_CHIPC_ADDR;
} else {
device_printf(dev, "unknown chip type %hhu\n", chip_type);
error = ENODEV;
goto cleanup;
}
*result = bhnd_parse_chipid(reg, enum_addr);
/* Fix the core count on early siba(4) devices */
if (chip_type == BHND_CHIPTYPE_SIBA) {
uint32_t idh;
uint16_t chipc_hwrev;
/*
* We need the ChipCommon revision to determine whether
* the ncore field is valid.
*
* We can safely assume the siba IDHIGH register is mapped
* within the chipc register block.
*/
idh = bus_read_4(res, SB0_REG_ABS(SIBA_CFG0_IDHIGH));
chipc_hwrev = SIBA_IDH_CORE_REV(idh);
error = bhnd_chipid_fixed_ncores(result, chipc_hwrev,
&result->ncores);
if (error)
goto cleanup;
}
cleanup:
/* Clean up */
bus_release_resource(dev, rtype, rid, res);
return (error);
}
/**
* Read an NVRAM variable's NUL-terminated string value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] buf A buffer large enough to hold @p len bytes. On
* success, the NUL-terminated string value will be
* written to this buffer. This argment may be NULL if
* the value is not desired.
* @param len The maximum capacity of @p buf.
* @param[out] rlen On success, will be set to the actual size of
* the requested value (including NUL termination). This
* argment may be NULL if the size is not desired.
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval ENOMEM If @p buf is non-NULL and a buffer of @p len is too
* small to hold the requested value.
* @retval EFTYPE If the variable data cannot be coerced to a valid
* string representation.
* @retval ERANGE If value coercion would overflow @p type.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_str(device_t dev, const char *name, char *buf, size_t len,
size_t *rlen)
{
size_t larg;
int error;
larg = len;
error = bhnd_nvram_getvar(dev, name, buf, &larg,
BHND_NVRAM_TYPE_STRING);
if (rlen != NULL)
*rlen = larg;
return (error);
}
/**
* Read an NVRAM variable's unsigned integer value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] value On success, the requested value will be written
* to this pointer.
* @param width The output integer type width (1, 2, or
* 4 bytes).
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid unsigned integer representation.
* @retval ERANGE If value coercion would overflow (or underflow) an
* unsigned representation of the given @p width.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_uint(device_t dev, const char *name, void *value, int width)
{
bhnd_nvram_type type;
size_t len;
switch (width) {
case 1:
type = BHND_NVRAM_TYPE_UINT8;
break;
case 2:
type = BHND_NVRAM_TYPE_UINT16;
break;
case 4:
type = BHND_NVRAM_TYPE_UINT32;
break;
default:
device_printf(dev, "unsupported NVRAM integer width: %d\n",
width);
return (EINVAL);
}
len = width;
return (bhnd_nvram_getvar(dev, name, value, &len, type));
}
/**
* Read an NVRAM variable's unsigned 8-bit integer value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] value On success, the requested value will be written
* to this pointer.
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid unsigned integer representation.
* @retval ERANGE If value coercion would overflow (or underflow) uint8_t.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_uint8(device_t dev, const char *name, uint8_t *value)
{
return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value)));
}
/**
* Read an NVRAM variable's unsigned 16-bit integer value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] value On success, the requested value will be written
* to this pointer.
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid unsigned integer representation.
* @retval ERANGE If value coercion would overflow (or underflow)
* uint16_t.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_uint16(device_t dev, const char *name, uint16_t *value)
{
return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value)));
}
/**
* Read an NVRAM variable's unsigned 32-bit integer value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] value On success, the requested value will be written
* to this pointer.
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid unsigned integer representation.
* @retval ERANGE If value coercion would overflow (or underflow)
* uint32_t.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_uint32(device_t dev, const char *name, uint32_t *value)
{
return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value)));
}
/**
* Read an NVRAM variable's signed integer value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] value On success, the requested value will be written
* to this pointer.
* @param width The output integer type width (1, 2, or
* 4 bytes).
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid integer representation.
* @retval ERANGE If value coercion would overflow (or underflow) an
* signed representation of the given @p width.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_int(device_t dev, const char *name, void *value, int width)
{
bhnd_nvram_type type;
size_t len;
switch (width) {
case 1:
type = BHND_NVRAM_TYPE_INT8;
break;
case 2:
type = BHND_NVRAM_TYPE_INT16;
break;
case 4:
type = BHND_NVRAM_TYPE_INT32;
break;
default:
device_printf(dev, "unsupported NVRAM integer width: %d\n",
width);
return (EINVAL);
}
len = width;
return (bhnd_nvram_getvar(dev, name, value, &len, type));
}
/**
* Read an NVRAM variable's signed 8-bit integer value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] value On success, the requested value will be written
* to this pointer.
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid integer representation.
* @retval ERANGE If value coercion would overflow (or underflow) int8_t.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_int8(device_t dev, const char *name, int8_t *value)
{
return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value)));
}
/**
* Read an NVRAM variable's signed 16-bit integer value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] value On success, the requested value will be written
* to this pointer.
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid integer representation.
* @retval ERANGE If value coercion would overflow (or underflow)
* int16_t.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_int16(device_t dev, const char *name, int16_t *value)
{
return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value)));
}
/**
* Read an NVRAM variable's signed 32-bit integer value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] value On success, the requested value will be written
* to this pointer.
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid integer representation.
* @retval ERANGE If value coercion would overflow (or underflow)
* int32_t.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_int32(device_t dev, const char *name, int32_t *value)
{
return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value)));
}
/**
* Read an NVRAM variable's array value.
*
* @param dev A bhnd bus child device.
* @param name The NVRAM variable name.
* @param[out] buf A buffer large enough to hold @p size bytes.
* On success, the requested value will be written
* to this buffer.
* @param[in,out] size The required number of bytes to write to
* @p buf.
* @param type The desired array element data representation.
*
* @retval 0 success
* @retval ENOENT The requested variable was not found.
* @retval ENODEV No valid NVRAM source could be found.
* @retval ENXIO If less than @p size bytes are available.
* @retval ENOMEM If a buffer of @p size is too small to hold the
* requested value.
* @retval EFTYPE If the variable data cannot be coerced to a
* a valid instance of @p type.
* @retval ERANGE If value coercion would overflow (or underflow) a
* representation of @p type.
* @retval non-zero If reading @p name otherwise fails, a regular unix
* error code will be returned.
*/
int
bhnd_nvram_getvar_array(device_t dev, const char *name, void *buf, size_t size,
bhnd_nvram_type type)
{
size_t nbytes;
int error;
/* Attempt read */
nbytes = size;
if ((error = bhnd_nvram_getvar(dev, name, buf, &nbytes, type)))
return (error);
/* Verify that the expected number of bytes were fetched */
if (nbytes < size)
return (ENXIO);
return (0);
}
/**
* Initialize a service provider registry.
*
* @param bsr The service registry to initialize.
*
* @retval 0 success
* @retval non-zero if an error occurs initializing the service registry,
* a regular unix error code will be returned.
*/
int
bhnd_service_registry_init(struct bhnd_service_registry *bsr)
{
STAILQ_INIT(&bsr->entries);
mtx_init(&bsr->lock, "bhnd_service_registry lock", NULL, MTX_DEF);
return (0);
}
/**
* Release all resources held by @p bsr.
*
* @param bsr A service registry instance previously successfully
* initialized via bhnd_service_registry_init().
*
* @retval 0 success
* @retval EBUSY if active references to service providers registered
* with @p bsr exist.
*/
int
bhnd_service_registry_fini(struct bhnd_service_registry *bsr)
{
struct bhnd_service_entry *entry, *enext;
/* Remove everthing we can */
mtx_lock(&bsr->lock);
STAILQ_FOREACH_SAFE(entry, &bsr->entries, link, enext) {
if (entry->refs > 0)
continue;
STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry, link);
free(entry, M_BHND);
}
if (!STAILQ_EMPTY(&bsr->entries)) {
mtx_unlock(&bsr->lock);
return (EBUSY);
}
mtx_unlock(&bsr->lock);
mtx_destroy(&bsr->lock);
return (0);
}
/**
* Register a @p provider for the given @p service.
*
* @param bsr Service registry to be modified.
* @param provider Service provider to register.
* @param service Service for which @p provider will be registered.
* @param flags Service provider flags (see BHND_SPF_*).
*
* @retval 0 success
* @retval EEXIST if an entry for @p service already exists.
* @retval EINVAL if @p service is BHND_SERVICE_ANY.
* @retval non-zero if registering @p provider otherwise fails, a regular
* unix error code will be returned.
*/
int
bhnd_service_registry_add(struct bhnd_service_registry *bsr, device_t provider,
bhnd_service_t service, uint32_t flags)
{
struct bhnd_service_entry *entry;
if (service == BHND_SERVICE_ANY)
return (EINVAL);
mtx_lock(&bsr->lock);
/* Is a service provider already registered? */
STAILQ_FOREACH(entry, &bsr->entries, link) {
if (entry->service == service) {
mtx_unlock(&bsr->lock);
return (EEXIST);
}
}
/* Initialize and insert our new entry */
entry = malloc(sizeof(*entry), M_BHND, M_NOWAIT);
if (entry == NULL) {
mtx_unlock(&bsr->lock);
return (ENOMEM);
}
entry->provider = provider;
entry->service = service;
entry->flags = flags;
refcount_init(&entry->refs, 0);
STAILQ_INSERT_HEAD(&bsr->entries, entry, link);
mtx_unlock(&bsr->lock);
return (0);
}
/**
* Free an unreferenced registry entry.
*
* @param entry The entry to be deallocated.
*/
static void
bhnd_service_registry_free_entry(struct bhnd_service_entry *entry)
{
KASSERT(entry->refs == 0, ("provider has active references"));
free(entry, M_BHND);
}
/**
* Attempt to remove the @p service provider registration for @p provider.
*
* @param bsr The service registry to be modified.
* @param provider The service provider to be deregistered.
* @param service The service for which @p provider will be deregistered,
* or BHND_SERVICE_ANY to remove all service
* registrations for @p provider.
*
* @retval 0 success
* @retval EBUSY if active references to @p provider exist; @see
* bhnd_service_registry_retain() and
* bhnd_service_registry_release().
*/
int
bhnd_service_registry_remove(struct bhnd_service_registry *bsr,
device_t provider, bhnd_service_t service)
{
struct bhnd_service_entry *entry, *enext;
mtx_lock(&bsr->lock);
#define BHND_PROV_MATCH(_e) \
((_e)->provider == provider && \
(service == BHND_SERVICE_ANY || (_e)->service == service))
/* Validate matching provider entries before making any
* modifications */
STAILQ_FOREACH(entry, &bsr->entries, link) {
/* Skip non-matching entries */
if (!BHND_PROV_MATCH(entry))
continue;
/* Entry is in use? */
if (entry->refs > 0) {
mtx_unlock(&bsr->lock);
return (EBUSY);
}
}
/* We can now safely remove matching entries */
STAILQ_FOREACH_SAFE(entry, &bsr->entries, link, enext) {
/* Skip non-matching entries */
if (!BHND_PROV_MATCH(entry))
continue;
/* Remove from list */
STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry, link);
/* Free provider entry */
bhnd_service_registry_free_entry(entry);
}
#undef BHND_PROV_MATCH
mtx_unlock(&bsr->lock);
return (0);
}
/**
* Retain and return a reference to a registered @p service provider, if any.
*
* @param bsr The service registry to be queried.
* @param service The service for which a provider should be returned.
*
* On success, the caller assumes ownership the returned provider, and
* is responsible for releasing this reference via
* bhnd_service_registry_release().
*
* @retval device_t success
* @retval NULL if no provider is registered for @p service.
*/
device_t
bhnd_service_registry_retain(struct bhnd_service_registry *bsr,
bhnd_service_t service)
{
struct bhnd_service_entry *entry;
mtx_lock(&bsr->lock);
STAILQ_FOREACH(entry, &bsr->entries, link) {
if (entry->service != service)
continue;
/* With a live refcount, entry is gauranteed to remain alive
* after we release our lock */
refcount_acquire(&entry->refs);
mtx_unlock(&bsr->lock);
return (entry->provider);
}
mtx_unlock(&bsr->lock);
/* Not found */
return (NULL);
}
/**
* Release a reference to a service provider previously returned by
* bhnd_service_registry_retain().
*
* If this is the last reference to an inherited service provider registration
* (@see BHND_SPF_INHERITED), the registration will also be removed, and
* true will be returned.
*
* @param bsr The service registry from which @p provider
* was returned.
* @param provider The provider to be released.
* @param service The service for which @p provider was previously
* retained.
* @retval true The inherited service provider registration was removed;
* the caller should release its own reference to the
* provider.
* @retval false The service provider was not inherited, or active
* references to the provider remain.
*/
bool
bhnd_service_registry_release(struct bhnd_service_registry *bsr,
device_t provider, bhnd_service_t service)
{
struct bhnd_service_entry *entry;
/* Exclusive lock, as we need to prevent any new references to the
* entry from being taken if it's to be removed */
mtx_lock(&bsr->lock);
STAILQ_FOREACH(entry, &bsr->entries, link) {
bool removed;
if (entry->provider != provider)
continue;
if (entry->service != service)
continue;
if (refcount_release(&entry->refs) &&
(entry->flags & BHND_SPF_INHERITED))
{
/* If an inherited entry is no longer actively
* referenced, remove the local registration and inform
* the caller. */
STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry,
link);
bhnd_service_registry_free_entry(entry);
removed = true;
} else {
removed = false;
}
mtx_unlock(&bsr->lock);
return (removed);
}
/* Caller owns a reference, but no such provider is registered? */
panic("invalid service provider reference");
}
/**
* Using the bhnd(4) bus-level core information and a custom core name,
* populate @p dev's device description.
*
* @param dev A bhnd-bus attached device.
* @param dev_name The core's name (e.g. "SDIO Device Core")
*/
void
bhnd_set_custom_core_desc(device_t dev, const char *dev_name)
{
const char *vendor_name;
char *desc;
vendor_name = bhnd_get_vendor_name(dev);
asprintf(&desc, M_BHND, "%s %s, rev %hhu", vendor_name, dev_name,
bhnd_get_hwrev(dev));
if (desc != NULL) {
device_set_desc_copy(dev, desc);
free(desc, M_BHND);
} else {
device_set_desc(dev, dev_name);
}
}
/**
* Using the bhnd(4) bus-level core information, populate @p dev's device
* description.
*
* @param dev A bhnd-bus attached device.
*/
void
bhnd_set_default_core_desc(device_t dev)
{
bhnd_set_custom_core_desc(dev, bhnd_get_device_name(dev));
}
/**
* Using the bhnd @p chip_id, populate the bhnd(4) bus @p dev's device
* description.
*
* @param dev A bhnd-bus attached device.
*/
void
bhnd_set_default_bus_desc(device_t dev, const struct bhnd_chipid *chip_id)
{
const char *bus_name;
char *desc;
char chip_name[BHND_CHIPID_MAX_NAMELEN];
/* Determine chip type's bus name */
switch (chip_id->chip_type) {
case BHND_CHIPTYPE_SIBA:
bus_name = "SIBA bus";
break;
case BHND_CHIPTYPE_BCMA:
case BHND_CHIPTYPE_BCMA_ALT:
bus_name = "BCMA bus";
break;
case BHND_CHIPTYPE_UBUS:
bus_name = "UBUS bus";
break;
default:
bus_name = "Unknown Type";
break;
}
/* Format chip name */
bhnd_format_chip_id(chip_name, sizeof(chip_name),
chip_id->chip_id);
/* Format and set device description */
asprintf(&desc, M_BHND, "%s %s", chip_name, bus_name);
if (desc != NULL) {
device_set_desc_copy(dev, desc);
free(desc, M_BHND);
} else {
device_set_desc(dev, bus_name);
}
}
/**
* Helper function for implementing BHND_BUS_REGISTER_PROVIDER().
*
* This implementation delegates the request to the BHND_BUS_REGISTER_PROVIDER()
* method on the parent of @p dev. If no parent exists, the implementation
* will return an error.
*/
int
bhnd_bus_generic_register_provider(device_t dev, device_t child,
device_t provider, bhnd_service_t service)
{
device_t parent = device_get_parent(dev);
if (parent != NULL) {
return (BHND_BUS_REGISTER_PROVIDER(parent, child,
provider, service));
}
return (ENXIO);
}
/**
* Helper function for implementing BHND_BUS_DEREGISTER_PROVIDER().
*
* This implementation delegates the request to the
* BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent
* exists, the implementation will panic.
*/
int
bhnd_bus_generic_deregister_provider(device_t dev, device_t child,
device_t provider, bhnd_service_t service)
{
device_t parent = device_get_parent(dev);
if (parent != NULL) {
return (BHND_BUS_DEREGISTER_PROVIDER(parent, child,
provider, service));
}
panic("missing BHND_BUS_DEREGISTER_PROVIDER()");
}
/**
* Helper function for implementing BHND_BUS_RETAIN_PROVIDER().
*
* This implementation delegates the request to the
* BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent
* exists, the implementation will return NULL.
*/
device_t
bhnd_bus_generic_retain_provider(device_t dev, device_t child,
bhnd_service_t service)
{
device_t parent = device_get_parent(dev);
if (parent != NULL) {
return (BHND_BUS_RETAIN_PROVIDER(parent, child,
service));
}
return (NULL);
}
/**
* Helper function for implementing BHND_BUS_RELEASE_PROVIDER().
*
* This implementation delegates the request to the
* BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent
* exists, the implementation will panic.
*/
void
bhnd_bus_generic_release_provider(device_t dev, device_t child,
device_t provider, bhnd_service_t service)
{
device_t parent = device_get_parent(dev);
if (parent != NULL) {
return (BHND_BUS_RELEASE_PROVIDER(parent, child,
provider, service));
}
panic("missing BHND_BUS_RELEASE_PROVIDER()");
}
/**
* Helper function for implementing BHND_BUS_REGISTER_PROVIDER().
*
* This implementation uses the bhnd_service_registry_add() function to
* do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find
* a suitable service registry to edit.
*/
int
bhnd_bus_generic_sr_register_provider(device_t dev, device_t child,
device_t provider, bhnd_service_t service)
{
struct bhnd_service_registry *bsr;
bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child);
KASSERT(bsr != NULL, ("NULL service registry"));
return (bhnd_service_registry_add(bsr, provider, service, 0));
}
/**
* Helper function for implementing BHND_BUS_DEREGISTER_PROVIDER().
*
* This implementation uses the bhnd_service_registry_remove() function to
* do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find
* a suitable service registry to edit.
*/
int
bhnd_bus_generic_sr_deregister_provider(device_t dev, device_t child,
device_t provider, bhnd_service_t service)
{
struct bhnd_service_registry *bsr;
bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child);
KASSERT(bsr != NULL, ("NULL service registry"));
return (bhnd_service_registry_remove(bsr, provider, service));
}
/**
* Helper function for implementing BHND_BUS_RETAIN_PROVIDER().
*
* This implementation uses the bhnd_service_registry_retain() function to
* do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find
* a suitable service registry.
*
* If a local provider for the service is not available, and a parent device is
* available, this implementation will attempt to fetch and locally register
* a service provider reference from the parent of @p dev.
*/
device_t
bhnd_bus_generic_sr_retain_provider(device_t dev, device_t child,
bhnd_service_t service)
{
struct bhnd_service_registry *bsr;
device_t parent, provider;
int error;
bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child);
KASSERT(bsr != NULL, ("NULL service registry"));
/*
* Attempt to fetch a service provider reference from either the local
* service registry, or if not found, from our parent.
*
* If we fetch a provider from our parent, we register the provider
* with the local service registry to prevent conflicting local
* registrations from being added.
*/
while (1) {
/* Check the local service registry first */
provider = bhnd_service_registry_retain(bsr, service);
if (provider != NULL)
return (provider);
/* Otherwise, try to delegate to our parent (if any) */
if ((parent = device_get_parent(dev)) == NULL)
return (NULL);
provider = BHND_BUS_RETAIN_PROVIDER(parent, dev, service);
if (provider == NULL)
return (NULL);
/* Register the inherited service registration with the local
* registry */
error = bhnd_service_registry_add(bsr, provider, service,
BHND_SPF_INHERITED);
if (error) {
BHND_BUS_RELEASE_PROVIDER(parent, dev, provider,
service);
if (error == EEXIST) {
/* A valid service provider was registered
* concurrently; retry fetching from the local
* registry */
continue;
}
device_printf(dev, "failed to register service "
"provider: %d\n", error);
return (NULL);
}
}
}
/**
* Helper function for implementing BHND_BUS_RELEASE_PROVIDER().
*
* This implementation uses the bhnd_service_registry_release() function to
* do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find
* a suitable service registry.
*/
void
bhnd_bus_generic_sr_release_provider(device_t dev, device_t child,
device_t provider, bhnd_service_t service)
{
struct bhnd_service_registry *bsr;
bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child);
KASSERT(bsr != NULL, ("NULL service registry"));
/* Release the provider reference; if the refcount hits zero on an
* inherited reference, true will be returned, and we need to drop
* our own bus reference to the provider */
if (!bhnd_service_registry_release(bsr, provider, service))
return;
/* Drop our reference to the borrowed provider */
BHND_BUS_RELEASE_PROVIDER(device_get_parent(dev), dev, provider,
service);
}
/**
* Helper function for implementing BHND_BUS_IS_HW_DISABLED().
*
* If a parent device is available, this implementation delegates the
* request to the BHND_BUS_IS_HW_DISABLED() method on the parent of @p dev.
*
* If no parent device is available (i.e. on a the bus root), the hardware
* is assumed to be usable and false is returned.
*/
bool
bhnd_bus_generic_is_hw_disabled(device_t dev, device_t child)
{
if (device_get_parent(dev) != NULL)
return (BHND_BUS_IS_HW_DISABLED(device_get_parent(dev), child));
return (false);
}
/**
* Helper function for implementing BHND_BUS_GET_CHIPID().
*
* This implementation delegates the request to the BHND_BUS_GET_CHIPID()
* method on the parent of @p dev. If no parent exists, the implementation
* will panic.
*/
const struct bhnd_chipid *
bhnd_bus_generic_get_chipid(device_t dev, device_t child)
{
if (device_get_parent(dev) != NULL)
return (BHND_BUS_GET_CHIPID(device_get_parent(dev), child));
panic("missing BHND_BUS_GET_CHIPID()");
}
/* nvram board_info population macros for bhnd_bus_generic_read_board_info() */
#define BHND_GV(_dest, _name) \
bhnd_nvram_getvar_uint(child, BHND_NVAR_ ## _name, &_dest, \
sizeof(_dest))
#define REQ_BHND_GV(_dest, _name) do { \
if ((error = BHND_GV(_dest, _name))) { \
device_printf(dev, \
"error reading " __STRING(_name) ": %d\n", error); \
return (error); \
} \
} while(0)
#define OPT_BHND_GV(_dest, _name, _default) do { \
if ((error = BHND_GV(_dest, _name))) { \
if (error != ENOENT) { \
device_printf(dev, \
"error reading " \
__STRING(_name) ": %d\n", error); \
return (error); \
} \
_dest = _default; \
} \
} while(0)
/**
* Helper function for implementing BHND_BUS_READ_BOARDINFO().
*
* This implementation populates @p info with information from NVRAM,
* defaulting board_vendor and board_type fields to 0 if the
* requested variables cannot be found.
*
* This behavior is correct for most SoCs, but must be overridden on
* bridged (PCI, PCMCIA, etc) devices to produce a complete bhnd_board_info
* result.
*/
int
bhnd_bus_generic_read_board_info(device_t dev, device_t child,
struct bhnd_board_info *info)
{
int error;
OPT_BHND_GV(info->board_vendor, BOARDVENDOR, 0);
OPT_BHND_GV(info->board_type, BOARDTYPE, 0); /* srom >= 2 */
REQ_BHND_GV(info->board_rev, BOARDREV);
OPT_BHND_GV(info->board_srom_rev,SROMREV, 0); /* missing in
some SoC
NVRAM */
REQ_BHND_GV(info->board_flags, BOARDFLAGS);
OPT_BHND_GV(info->board_flags2, BOARDFLAGS2, 0); /* srom >= 4 */
OPT_BHND_GV(info->board_flags3, BOARDFLAGS3, 0); /* srom >= 11 */
return (0);
}
#undef BHND_GV
#undef BHND_GV_REQ
#undef BHND_GV_OPT
/**
* Helper function for implementing BHND_BUS_GET_NVRAM_VAR().
*
* This implementation searches @p dev for a usable NVRAM child device.
*
* If no usable child device is found on @p dev, the request is delegated to
* the BHND_BUS_GET_NVRAM_VAR() method on the parent of @p dev.
*/
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)
{
device_t nvram;
device_t parent;
/* Make sure we're holding Giant for newbus */
GIANT_REQUIRED;
/* Look for a directly-attached NVRAM child */
if ((nvram = device_find_child(dev, "bhnd_nvram", -1)) != NULL)
return BHND_NVRAM_GETVAR(nvram, name, buf, size, type);
/* Try to delegate to parent */
if ((parent = device_get_parent(dev)) == NULL)
return (ENODEV);
return (BHND_BUS_GET_NVRAM_VAR(device_get_parent(dev), child,
name, buf, size, type));
}
/**
* Helper function for implementing BHND_BUS_ALLOC_RESOURCE().
*
* This implementation of BHND_BUS_ALLOC_RESOURCE() delegates allocation
* of the underlying resource to BUS_ALLOC_RESOURCE(), and activation
* to @p dev's BHND_BUS_ACTIVATE_RESOURCE().
*/
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)
{
struct bhnd_resource *br;
struct resource *res;
int error;
br = NULL;
res = NULL;
/* Allocate the real bus resource (without activating it) */
res = BUS_ALLOC_RESOURCE(dev, child, type, rid, start, end, count,
(flags & ~RF_ACTIVE));
if (res == NULL)
return (NULL);
/* Allocate our bhnd resource wrapper. */
br = malloc(sizeof(struct bhnd_resource), M_BHND, M_NOWAIT);
if (br == NULL)
goto failed;
br->direct = false;
br->res = res;
/* Attempt activation */
if (flags & RF_ACTIVE) {
error = BHND_BUS_ACTIVATE_RESOURCE(dev, child, type, *rid, br);
if (error)
goto failed;
}
return (br);
failed:
if (res != NULL)
BUS_RELEASE_RESOURCE(dev, child, type, *rid, res);
free(br, M_BHND);
return (NULL);
}
/**
* Helper function for implementing BHND_BUS_RELEASE_RESOURCE().
*
* This implementation of BHND_BUS_RELEASE_RESOURCE() delegates release of
* the backing resource to BUS_RELEASE_RESOURCE().
*/
int
bhnd_bus_generic_release_resource(device_t dev, device_t child, int type,
int rid, struct bhnd_resource *r)
{
int error;
if ((error = BUS_RELEASE_RESOURCE(dev, child, type, rid, r->res)))
return (error);
free(r, M_BHND);
return (0);
}
/**
* Helper function for implementing BHND_BUS_ACTIVATE_RESOURCE().
*
* This implementation of BHND_BUS_ACTIVATE_RESOURCE() first calls the
* BHND_BUS_ACTIVATE_RESOURCE() method of the parent of @p dev.
*
* If this fails, and if @p dev is the direct parent of @p child, standard
* resource activation is attempted via bus_activate_resource(). This enables
* direct use of the bhnd(4) resource APIs on devices that may not be attached
* to a parent bhnd bus or bridge.
*/
int
bhnd_bus_generic_activate_resource(device_t dev, device_t child, int type,
int rid, struct bhnd_resource *r)
{
int error;
bool passthrough;
passthrough = (device_get_parent(child) != dev);
/* Try to delegate to the parent */
if (device_get_parent(dev) != NULL) {
error = BHND_BUS_ACTIVATE_RESOURCE(device_get_parent(dev),
child, type, rid, r);
} else {
error = ENODEV;
}
/* If bhnd(4) activation has failed and we're the child's direct
* parent, try falling back on standard resource activation.
*/
if (error && !passthrough) {
error = bus_activate_resource(child, type, rid, r->res);
if (!error)
r->direct = true;
}
return (error);
}
/**
* Helper function for implementing BHND_BUS_DEACTIVATE_RESOURCE().
*
* This implementation of BHND_BUS_ACTIVATE_RESOURCE() simply calls the
* BHND_BUS_ACTIVATE_RESOURCE() method of the parent of @p dev.
*/
int
bhnd_bus_generic_deactivate_resource(device_t dev, device_t child,
int type, int rid, struct bhnd_resource *r)
{
if (device_get_parent(dev) != NULL)
return (BHND_BUS_DEACTIVATE_RESOURCE(device_get_parent(dev),
child, type, rid, r));
return (EINVAL);
}
Reference in New Issue View Git Blame Copy Permalink