2016-02-26 03:34:08 +00:00
|
|
|
/*-
|
2017-12-08 15:57:29 +00:00
|
|
|
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
|
|
|
|
*
|
2017-09-27 19:44:23 +00:00
|
|
|
* Copyright (c) 2015-2016 Landon Fuller <landon@landonf.org>
|
|
|
|
* Copyright (c) 2017 The FreeBSD Foundation
|
2016-02-26 03:34:08 +00:00
|
|
|
* All rights reserved.
|
|
|
|
*
|
2017-09-27 19:44:23 +00:00
|
|
|
* Portions of this software were developed by Landon Fuller
|
|
|
|
* under sponsorship from the FreeBSD Foundation.
|
|
|
|
*
|
2016-02-26 03:34:08 +00:00
|
|
|
* 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$");
|
|
|
|
|
2016-05-02 21:01:08 +00:00
|
|
|
#include <sys/param.h>
|
2016-02-26 03:34:08 +00:00
|
|
|
#include <sys/bus.h>
|
2017-09-27 19:44:23 +00:00
|
|
|
#include <sys/refcount.h>
|
2016-02-26 03:34:08 +00:00
|
|
|
#include <sys/systm.h>
|
|
|
|
|
|
|
|
#include <machine/bus.h>
|
|
|
|
#include <sys/rman.h>
|
|
|
|
#include <machine/resource.h>
|
|
|
|
|
2016-08-28 20:39:53 +00:00
|
|
|
#include <dev/bhnd/siba/sibareg.h>
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
#include <dev/bhnd/cores/chipc/chipcreg.h>
|
|
|
|
|
2016-05-17 00:23:46 +00:00
|
|
|
#include "nvram/bhnd_nvram.h"
|
|
|
|
|
|
|
|
#include "bhnd_chipc_if.h"
|
|
|
|
|
|
|
|
#include "bhnd_nvram_if.h"
|
|
|
|
#include "bhnd_nvram_map.h"
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
#include "bhndreg.h"
|
|
|
|
#include "bhndvar.h"
|
2017-09-27 19:44:23 +00:00
|
|
|
#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);
|
2016-02-26 03:34:08 +00:00
|
|
|
|
|
|
|
/* 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"),
|
2016-09-18 21:28:09 +00:00
|
|
|
BHND_CDESC(BCM, MIPS, CPU, "BMIPS CPU"),
|
2016-02-26 03:34:08 +00:00
|
|
|
BHND_CDESC(BCM, ENET, ENET_MAC, "Fast Ethernet MAC"),
|
2018-01-19 22:43:08 +00:00
|
|
|
BHND_CDESC(BCM, V90_CODEC, SOFTMODEM, "V.90 SoftModem Codec"),
|
2016-09-05 21:48:16 +00:00
|
|
|
BHND_CDESC(BCM, USB, USB_DUAL, "USB 1.1 Device/Host Controller"),
|
2016-02-26 03:34:08 +00:00
|
|
|
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"),
|
2016-09-18 21:28:09 +00:00
|
|
|
BHND_CDESC(BCM, MIPS33, CPU, "BMIPS33 CPU"),
|
2016-09-05 21:48:16 +00:00
|
|
|
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"),
|
2016-02-26 03:34:08 +00:00
|
|
|
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"),
|
2016-06-08 21:38:51 +00:00
|
|
|
BHND_CDESC(MIPS,MIPS74K, CPU, "MIPS74k CPU"),
|
2016-02-26 03:34:08 +00:00
|
|
|
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"),
|
2016-09-05 21:48:16 +00:00
|
|
|
BHND_CDESC(BCM, NS_USB20H, USB_HOST, "USB 2.0 Host Controller"),
|
|
|
|
BHND_CDESC(BCM, NS_USB30H, USB_HOST, "USB 3.0 Host Controller"),
|
2016-02-26 03:34:08 +00:00
|
|
|
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 }
|
|
|
|
};
|
|
|
|
|
2017-11-22 20:27:46 +00:00
|
|
|
static const struct bhnd_device_quirk bhnd_chipc_clkctl_quirks[];
|
|
|
|
static const struct bhnd_device_quirk bhnd_pcmcia_clkctl_quirks[];
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Device table entries for core-specific CLKCTL quirk lookup.
|
|
|
|
*/
|
|
|
|
static const struct bhnd_device bhnd_clkctl_devices[] = {
|
|
|
|
BHND_DEVICE(BCM, CC, NULL, bhnd_chipc_clkctl_quirks),
|
|
|
|
BHND_DEVICE(BCM, PCMCIA, NULL, bhnd_pcmcia_clkctl_quirks),
|
|
|
|
BHND_DEVICE_END,
|
|
|
|
};
|
|
|
|
|
|
|
|
/** ChipCommon CLKCTL quirks */
|
|
|
|
static const struct bhnd_device_quirk bhnd_chipc_clkctl_quirks[] = {
|
|
|
|
/* HTAVAIL/ALPAVAIL are bitswapped in chipc's CLKCTL */
|
|
|
|
BHND_CHIP_QUIRK(4328, HWREV_ANY, BHND_CLKCTL_QUIRK_CCS0),
|
|
|
|
BHND_CHIP_QUIRK(5354, HWREV_ANY, BHND_CLKCTL_QUIRK_CCS0),
|
|
|
|
BHND_DEVICE_QUIRK_END
|
|
|
|
};
|
|
|
|
|
|
|
|
/** PCMCIA CLKCTL quirks */
|
|
|
|
static const struct bhnd_device_quirk bhnd_pcmcia_clkctl_quirks[] = {
|
|
|
|
/* HTAVAIL/ALPAVAIL are bitswapped in pcmcia's CLKCTL */
|
|
|
|
BHND_CHIP_QUIRK(4328, HWREV_ANY, BHND_CLKCTL_QUIRK_CCS0),
|
|
|
|
BHND_CHIP_QUIRK(5354, HWREV_ANY, BHND_CLKCTL_QUIRK_CCS0),
|
|
|
|
BHND_DEVICE_QUIRK_END
|
|
|
|
};
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
2017-11-27 21:30:49 +00:00
|
|
|
*
|
|
|
|
* @param port_type The port type to look up.
|
2016-02-26 03:34:08 +00:00
|
|
|
*/
|
|
|
|
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");
|
2016-05-05 15:07:40 +00:00
|
|
|
default:
|
|
|
|
return "unknown";
|
2016-02-26 03:34:08 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-07-12 02:16:48 +00:00
|
|
|
/**
|
|
|
|
* Return the name of an NVRAM source.
|
2017-11-27 21:30:49 +00:00
|
|
|
*
|
|
|
|
* @param nvram_src The NVRAM source type to look up.
|
2016-07-12 02:16:48 +00:00
|
|
|
*/
|
|
|
|
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");
|
|
|
|
}
|
|
|
|
}
|
2016-02-26 03:34:08 +00:00
|
|
|
|
|
|
|
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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @param vendor The core designer's JEDEC-106 Manufacturer ID.
|
2016-02-26 03:34:08 +00:00
|
|
|
* @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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @param vendor The core designer's JEDEC-106 Manufacturer ID.
|
2016-02-26 03:34:08 +00:00
|
|
|
* @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);
|
|
|
|
}
|
|
|
|
|
2016-08-27 00:07:48 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @return 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'.
|
2016-08-27 00:07:48 +00:00
|
|
|
*
|
|
|
|
* @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));
|
|
|
|
}
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
/**
|
2017-11-27 21:30:49 +00:00
|
|
|
* Return a core info record populated from a bhnd-attached @p dev.
|
2016-02-26 03:34:08 +00:00
|
|
|
*
|
|
|
|
* @param dev A bhnd device.
|
2017-11-27 21:30:49 +00:00
|
|
|
*
|
|
|
|
* @return A core info record for @p dev.
|
2016-02-26 03:34:08 +00:00
|
|
|
*/
|
|
|
|
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)
|
|
|
|
};
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2017-09-27 19:44:23 +00:00
|
|
|
* Find a @p class child device with @p unit on @p bus.
|
2016-02-26 03:34:08 +00:00
|
|
|
*
|
2017-09-27 19:44:23 +00:00
|
|
|
* @param bus The bhnd-compatible bus to be searched.
|
2016-02-26 03:34:08 +00:00
|
|
|
* @param class The device class to match on.
|
2016-07-12 02:16:48 +00:00
|
|
|
* @param unit The core unit number; specify -1 to return the first match
|
2016-02-26 03:34:08 +00:00
|
|
|
* 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
|
2017-09-27 19:44:23 +00:00
|
|
|
bhnd_bus_find_child(device_t bus, bhnd_devclass_t class, int unit)
|
2016-02-26 03:34:08 +00:00
|
|
|
{
|
|
|
|
struct bhnd_core_match md = {
|
2016-05-24 21:20:17 +00:00
|
|
|
BHND_MATCH_CORE_CLASS(class),
|
|
|
|
BHND_MATCH_CORE_UNIT(unit)
|
2016-02-26 03:34:08 +00:00
|
|
|
};
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (unit == -1)
|
|
|
|
md.m.match.core_unit = 0;
|
|
|
|
|
2017-09-27 19:44:23 +00:00
|
|
|
return bhnd_bus_match_child(bus, &md);
|
2016-02-26 03:34:08 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2017-09-27 19:44:23 +00:00
|
|
|
* Find the first child device on @p bus that matches @p desc.
|
2016-02-26 03:34:08 +00:00
|
|
|
*
|
2017-09-27 19:44:23 +00:00
|
|
|
* @param bus The bhnd-compatible bus to be searched.
|
2016-02-26 03:34:08 +00:00
|
|
|
* @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
|
2017-09-27 19:44:23 +00:00
|
|
|
bhnd_bus_match_child(device_t bus, const struct bhnd_core_match *desc)
|
2016-02-26 03:34:08 +00:00
|
|
|
{
|
|
|
|
device_t *devlistp;
|
|
|
|
device_t match;
|
|
|
|
int devcnt;
|
|
|
|
int error;
|
|
|
|
|
2017-09-27 19:44:23 +00:00
|
|
|
error = device_get_children(bus, &devlistp, &devcnt);
|
2016-02-26 03:34:08 +00:00
|
|
|
if (error != 0)
|
|
|
|
return (NULL);
|
|
|
|
|
|
|
|
match = NULL;
|
|
|
|
for (int i = 0; i < devcnt; i++) {
|
2016-05-24 21:20:17 +00:00
|
|
|
struct bhnd_core_info ci = bhnd_get_core_info(devlistp[i]);
|
|
|
|
|
|
|
|
if (bhnd_core_matches(&ci, desc)) {
|
|
|
|
match = devlistp[i];
|
2016-02-26 03:34:08 +00:00
|
|
|
goto done;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
done:
|
|
|
|
free(devlistp, M_TEMP);
|
|
|
|
return match;
|
|
|
|
}
|
|
|
|
|
2017-09-27 19:44:23 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
2017-11-27 21:30:49 +00:00
|
|
|
*
|
|
|
|
* @retval 0 success
|
|
|
|
* @retval EINVAL if the sort order is unknown.
|
2017-09-27 19:44:23 +00:00
|
|
|
*/
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2016-05-17 06:52:53 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval NULL if @p dev is not attached via a bhndb bus.
|
|
|
|
* @retval NULL if no parent device is attached via @p bus_class.
|
2016-05-17 06:52:53 +00:00
|
|
|
*/
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
2017-11-27 21:30:49 +00:00
|
|
|
* @param class The device class to match on.
|
2016-02-26 03:34:08 +00:00
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval non-NULL if a matching core is found.
|
2016-02-26 03:34:08 +00:00
|
|
|
* @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 = {
|
2016-05-24 21:20:17 +00:00
|
|
|
BHND_MATCH_CORE_CLASS(class)
|
2016-02-26 03:34:08 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
return bhnd_match_core(cores, num_cores, &md);
|
|
|
|
}
|
|
|
|
|
2016-09-04 00:58:19 +00:00
|
|
|
|
|
|
|
/**
|
|
|
|
* Create an equality match descriptor for @p core.
|
|
|
|
*
|
|
|
|
* @param core The core info to be matched on.
|
2017-11-27 21:30:49 +00:00
|
|
|
*
|
|
|
|
* @return an equality match descriptor for @p core.
|
2016-09-04 00:58:19 +00:00
|
|
|
*/
|
|
|
|
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)
|
|
|
|
});
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
2017-11-27 21:30:49 +00:00
|
|
|
* Return true if the @p lhs is equal to @p rhs.
|
2016-09-04 00:58:19 +00:00
|
|
|
*
|
|
|
|
* @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));
|
|
|
|
}
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval true if @p core matches @p match.
|
2016-02-26 03:34:08 +00:00
|
|
|
* @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)
|
|
|
|
{
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.core_vendor && desc->core_vendor != core->vendor)
|
2016-02-26 03:34:08 +00:00
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.core_id && desc->core_id != core->device)
|
2016-02-26 03:34:08 +00:00
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.core_unit && desc->core_unit != core->unit)
|
2016-02-26 03:34:08 +00:00
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.core_rev &&
|
|
|
|
!bhnd_hwrev_matches(core->hwrev, &desc->core_rev))
|
2016-02-26 03:34:08 +00:00
|
|
|
return (false);
|
|
|
|
|
2016-09-04 00:58:19 +00:00
|
|
|
if (desc->m.match.core_idx && desc->core_idx != core->core_idx)
|
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.core_class &&
|
|
|
|
desc->core_class != bhnd_core_class(core))
|
2016-02-26 03:34:08 +00:00
|
|
|
return (false);
|
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
2016-05-08 18:30:08 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval true if @p chip matches @p match.
|
2016-05-08 18:30:08 +00:00
|
|
|
* @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)
|
|
|
|
{
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.chip_id && chip->chip_id != desc->chip_id)
|
2016-05-08 18:30:08 +00:00
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.chip_pkg && chip->chip_pkg != desc->chip_pkg)
|
2016-05-08 18:30:08 +00:00
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.chip_rev &&
|
2016-05-08 18:30:08 +00:00
|
|
|
!bhnd_hwrev_matches(chip->chip_rev, &desc->chip_rev))
|
|
|
|
return (false);
|
|
|
|
|
2017-11-21 23:15:20 +00:00
|
|
|
if (desc->m.match.chip_type && chip->chip_type != desc->chip_type)
|
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
return (true);
|
|
|
|
}
|
2016-05-17 00:23:46 +00:00
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval true if @p chip matches @p match.
|
2016-05-24 21:20:17 +00:00
|
|
|
* @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 &&
|
2016-05-17 00:23:46 +00:00
|
|
|
!bhnd_hwrev_matches(board->board_srom_rev, &desc->board_srom_rev))
|
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.board_vendor &&
|
|
|
|
board->board_vendor != desc->board_vendor)
|
2016-05-17 00:23:46 +00:00
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.board_type && board->board_type != desc->board_type)
|
2016-05-17 00:23:46 +00:00
|
|
|
return (false);
|
|
|
|
|
2017-12-14 01:58:05 +00:00
|
|
|
if (desc->m.match.board_devid &&
|
|
|
|
board->board_devid != desc->board_devid)
|
|
|
|
return (false);
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
if (desc->m.match.board_rev &&
|
2016-05-17 00:23:46 +00:00
|
|
|
!bhnd_hwrev_matches(board->board_rev, &desc->board_rev))
|
|
|
|
return (false);
|
|
|
|
|
2016-05-08 18:30:08 +00:00
|
|
|
return (true);
|
|
|
|
}
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval true if @p hwrev matches @p match.
|
2016-02-26 03:34:08 +00:00
|
|
|
* @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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval true if @p dev matches @p match.
|
2016-02-26 03:34:08 +00:00
|
|
|
* @retval false if @p dev does not match @p match.
|
|
|
|
*/
|
|
|
|
bool
|
2016-05-24 21:20:17 +00:00
|
|
|
bhnd_device_matches(device_t dev, const struct bhnd_device_match *desc)
|
2016-02-26 03:34:08 +00:00
|
|
|
{
|
2016-05-24 21:20:17 +00:00
|
|
|
struct bhnd_core_info core;
|
|
|
|
const struct bhnd_chipid *chip;
|
|
|
|
struct bhnd_board_info board;
|
|
|
|
device_t parent;
|
|
|
|
int error;
|
2016-02-26 03:34:08 +00:00
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
/* 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);
|
2016-02-26 03:34:08 +00:00
|
|
|
}
|
|
|
|
|
2016-04-19 15:56:39 +00:00
|
|
|
/**
|
|
|
|
* 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.
|
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval non-NULL the first matching device, if any.
|
2016-04-19 15:56:39 +00:00
|
|
|
* @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)
|
|
|
|
{
|
2016-05-08 17:52:12 +00:00
|
|
|
const struct bhnd_device *entry;
|
|
|
|
device_t hostb, parent;
|
2016-05-24 21:20:17 +00:00
|
|
|
bhnd_attach_type attach_type;
|
|
|
|
uint32_t dflags;
|
2016-05-08 17:52:12 +00:00
|
|
|
|
|
|
|
parent = device_get_parent(dev);
|
2017-09-27 19:44:23 +00:00
|
|
|
hostb = bhnd_bus_find_hostb_device(parent);
|
2016-05-24 21:20:17 +00:00
|
|
|
attach_type = bhnd_get_attach_type(dev);
|
2016-04-19 15:56:39 +00:00
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
for (entry = table; !BHND_DEVICE_IS_END(entry); entry =
|
2016-04-19 15:56:39 +00:00
|
|
|
(const struct bhnd_device *) ((const char *) entry + entry_size))
|
|
|
|
{
|
|
|
|
/* match core info */
|
|
|
|
if (!bhnd_device_matches(dev, &entry->core))
|
|
|
|
continue;
|
|
|
|
|
|
|
|
/* match device flags */
|
2016-05-24 21:20:17 +00:00
|
|
|
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)
|
2016-05-08 17:52:12 +00:00
|
|
|
if (dev != hostb)
|
2016-04-19 15:56:39 +00:00
|
|
|
continue;
|
2016-05-24 21:20:17 +00:00
|
|
|
|
|
|
|
if (dflags & BHND_DF_SOC)
|
|
|
|
if (attach_type != BHND_ATTACH_NATIVE)
|
|
|
|
continue;
|
2016-04-19 15:56:39 +00:00
|
|
|
|
|
|
|
/* device found */
|
|
|
|
return (entry);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* not found */
|
|
|
|
return (NULL);
|
|
|
|
}
|
|
|
|
|
2016-05-08 18:30:08 +00:00
|
|
|
/**
|
2016-05-24 21:20:17 +00:00
|
|
|
* Scan the device @p table for all quirk flags applicable to @p dev.
|
2016-04-19 15:56:39 +00:00
|
|
|
*
|
|
|
|
* @param dev A bhnd device to match against @p table.
|
|
|
|
* @param table The device table to search.
|
2017-11-27 21:30:49 +00:00
|
|
|
* @param entry_size The @p table entry size, in bytes.
|
2016-04-19 15:56:39 +00:00
|
|
|
*
|
2017-11-27 21:30:49 +00:00
|
|
|
* @return all matching quirk flags.
|
2016-04-19 15:56:39 +00:00
|
|
|
*/
|
|
|
|
uint32_t
|
|
|
|
bhnd_device_quirks(device_t dev, const struct bhnd_device *table,
|
|
|
|
size_t entry_size)
|
|
|
|
{
|
|
|
|
const struct bhnd_device *dent;
|
2016-05-24 21:20:17 +00:00
|
|
|
const struct bhnd_device_quirk *qent, *qtable;
|
2016-04-19 15:56:39 +00:00
|
|
|
uint32_t quirks;
|
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
/* Locate the device entry */
|
|
|
|
if ((dent = bhnd_device_lookup(dev, table, entry_size)) == NULL)
|
|
|
|
return (0);
|
2016-04-19 15:56:39 +00:00
|
|
|
|
2016-05-24 21:20:17 +00:00
|
|
|
/* Quirks table is optional */
|
|
|
|
qtable = dent->quirks_table;
|
|
|
|
if (qtable == NULL)
|
2016-04-19 15:56:39 +00:00
|
|
|
return (0);
|
|
|
|
|
2016-05-17 00:23:46 +00:00
|
|
|
/* Collect matching device quirk entries */
|
2016-05-24 21:20:17 +00:00
|
|
|
quirks = 0;
|
|
|
|
for (qent = qtable; !BHND_DEVICE_QUIRK_IS_END(qent); qent++) {
|
|
|
|
if (bhnd_device_matches(dev, &qent->desc))
|
|
|
|
quirks |= qent->quirks;
|
2016-04-19 15:56:39 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
return (quirks);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
/**
|
|
|
|
* 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);
|
2016-09-06 13:34:10 +00:00
|
|
|
}
|
2016-02-26 03:34:08 +00:00
|
|
|
|
|
|
|
/**
|
|
|
|
* 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;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-11-22 20:27:46 +00:00
|
|
|
/**
|
|
|
|
* Allocate and return a new per-core PMU clock control/status (clkctl)
|
|
|
|
* instance for @p dev.
|
|
|
|
*
|
|
|
|
* @param dev The bhnd(4) core device mapped by @p r.
|
|
|
|
* @param pmu_dev The bhnd(4) PMU device, implmenting the bhnd_pmu_if
|
|
|
|
* interface. The caller is responsible for ensuring that
|
|
|
|
* this reference remains valid for the lifetime of the
|
|
|
|
* returned clkctl instance.
|
|
|
|
* @param r A resource mapping the core's clock control register
|
|
|
|
* (see BHND_CLK_CTL_ST). The caller is responsible for
|
|
|
|
* ensuring that this resource remains valid for the
|
|
|
|
* lifetime of the returned clkctl instance.
|
|
|
|
* @param offset The offset to the clock control register within @p r.
|
|
|
|
* @param max_latency The PMU's maximum state transition latency in
|
|
|
|
* microseconds; this upper bound will be used to busy-wait
|
|
|
|
* on PMU state transitions.
|
|
|
|
*
|
|
|
|
* @retval non-NULL success
|
|
|
|
* @retval NULL if allocation fails.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
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)
|
|
|
|
{
|
|
|
|
struct bhnd_core_clkctl *clkctl;
|
|
|
|
|
|
|
|
clkctl = malloc(sizeof(*clkctl), M_BHND, M_ZERO | M_NOWAIT);
|
|
|
|
if (clkctl == NULL)
|
|
|
|
return (NULL);
|
|
|
|
|
|
|
|
clkctl->cc_dev = dev;
|
|
|
|
clkctl->cc_pmu_dev = pmu_dev;
|
|
|
|
clkctl->cc_res = r;
|
|
|
|
clkctl->cc_res_offset = offset;
|
|
|
|
clkctl->cc_max_latency = max_latency;
|
|
|
|
clkctl->cc_quirks = bhnd_device_quirks(dev, bhnd_clkctl_devices,
|
|
|
|
sizeof(bhnd_clkctl_devices[0]));
|
|
|
|
|
|
|
|
BHND_CLKCTL_LOCK_INIT(clkctl);
|
|
|
|
|
|
|
|
return (clkctl);
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Free a clkctl instance previously allocated via bhnd_alloc_core_clkctl().
|
|
|
|
*
|
|
|
|
* @param clkctl The clkctl instance to be freed.
|
|
|
|
*/
|
|
|
|
void
|
|
|
|
bhnd_free_core_clkctl(struct bhnd_core_clkctl *clkctl)
|
|
|
|
{
|
|
|
|
BHND_CLKCTL_LOCK_DESTROY(clkctl);
|
|
|
|
|
|
|
|
free(clkctl, M_BHND);
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Wait for the per-core clock status to be equal to @p value after
|
|
|
|
* applying @p mask, timing out after the maximum transition latency is reached.
|
|
|
|
*
|
|
|
|
* @param clkctl Per-core clkctl state to be queryied.
|
|
|
|
* @param value Value to wait for.
|
|
|
|
* @param mask Mask to apply prior to value comparison.
|
|
|
|
*
|
|
|
|
* @retval 0 success
|
|
|
|
* @retval ETIMEDOUT if the PMU's maximum transition delay is reached before
|
|
|
|
* the clock status matches @p value and @p mask.
|
|
|
|
*/
|
|
|
|
int
|
|
|
|
bhnd_core_clkctl_wait(struct bhnd_core_clkctl *clkctl, uint32_t value,
|
|
|
|
uint32_t mask)
|
|
|
|
{
|
|
|
|
uint32_t clkst;
|
|
|
|
|
|
|
|
BHND_CLKCTL_LOCK_ASSERT(clkctl, MA_OWNED);
|
|
|
|
|
|
|
|
/* Bitswapped HTAVAIL/ALPAVAIL work-around */
|
|
|
|
if (clkctl->cc_quirks & BHND_CLKCTL_QUIRK_CCS0) {
|
|
|
|
uint32_t fmask, fval;
|
|
|
|
|
|
|
|
fmask = mask & ~(BHND_CCS_HTAVAIL | BHND_CCS_ALPAVAIL);
|
|
|
|
fval = value & ~(BHND_CCS_HTAVAIL | BHND_CCS_ALPAVAIL);
|
|
|
|
|
|
|
|
if (mask & BHND_CCS_HTAVAIL)
|
|
|
|
fmask |= BHND_CCS0_HTAVAIL;
|
|
|
|
if (value & BHND_CCS_HTAVAIL)
|
|
|
|
fval |= BHND_CCS0_HTAVAIL;
|
|
|
|
|
|
|
|
if (mask & BHND_CCS_ALPAVAIL)
|
|
|
|
fmask |= BHND_CCS0_ALPAVAIL;
|
|
|
|
if (value & BHND_CCS_ALPAVAIL)
|
|
|
|
fval |= BHND_CCS0_ALPAVAIL;
|
|
|
|
|
|
|
|
mask = fmask;
|
|
|
|
value = fval;
|
|
|
|
}
|
|
|
|
|
|
|
|
for (u_int i = 0; i < clkctl->cc_max_latency; i += 10) {
|
|
|
|
clkst = bhnd_bus_read_4(clkctl->cc_res, clkctl->cc_res_offset);
|
|
|
|
if ((clkst & mask) == (value & mask))
|
|
|
|
return (0);
|
|
|
|
|
|
|
|
DELAY(10);
|
|
|
|
}
|
|
|
|
|
|
|
|
device_printf(clkctl->cc_dev, "clkst wait timeout (value=%#x, "
|
|
|
|
"mask=%#x)\n", value, mask);
|
|
|
|
|
|
|
|
return (ETIMEDOUT);
|
|
|
|
}
|
|
|
|
|
2016-08-16 21:32:05 +00:00
|
|
|
/**
|
|
|
|
* 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;
|
bhnd(4): Unify NVRAM/SPROM parsing, implement compact SPROM layout encoding.
- Defined an abstract NVRAM I/O API (bhnd_nvram_io), decoupling NVRAM/SPROM
parsing from the actual underlying NVRAM data provider (e.g. CFE firmware
devices).
- Defined an abstract NVRAM data API (bhnd_nvram_data), decoupling
higher-level NVRAM operations (indexed lookup, data conversion, etc) from
the underlying NVRAM file format parsing/serialization.
- Implemented a new high-level bhnd_nvram_store API, providing indexed
variable lookup, pending write tracking, etc on top of an arbitrary
bhnd_nvram_data instance.
- Migrated all bhnd(4) NVRAM device drivers to the common bhnd_nvram_store
API.
- Implemented a common bhnd_nvram_val API for parsing/encoding NVRAM
variable values, including applying format-specific behavior when
converting to/from the NVRAM string representations.
- Dropped the now unnecessary bhnd_nvram driver, and moved the
broadcom/mips-specific CFE NVRAM driver out into sys/mips/broadcom.
- Implemented a new nvram_map file format:
- Variable definitions are now defined separately from the SPROM
layout. This will also allow us to define CIS tuple NVRAM
mappings referencing the common NVRAM variable definitions.
- Variables can now be defined within arbitrary named groups.
- Textual descriptions and help information can be defined inline
for both variables and variable groups.
- Implemented a new, compact encoding of SPROM image layout
offsets.
- Source-level (but not build system) support for building the NVRAM file
format APIs (bhnd_nvram_io, bhnd_nvram_data, bhnd_nvram_store) as a
userspace library.
The new compact SPROM image layout encoding is loosely modeled on Apple
dyld compressed LINKEDIT symbol binding opcodes; it provides a compact
state-machine encoding of the mapping between NVRAM variables and the SPROM
image offset, mask, and shift instructions necessary to decode or encode
the SPROM variable data.
The compact encoding reduces the size of the generated SPROM layout data
from roughly 60KB to 3KB. The sequential nature SPROM layout opcode tables
also simplify iteration of the SPROM variables, as it's no longer
neccessary to iterate the full NVRAM variable definition table, but
instead simply scan the SPROM revision's layout opcode table.
Approved by: adrian (mentor)
Differential Revision: https://reviews.freebsd.org/D8645
2016-11-26 23:22:32 +00:00
|
|
|
error = bhnd_nvram_getvar(dev, name, buf, &larg,
|
|
|
|
BHND_NVRAM_TYPE_STRING);
|
2016-08-16 21:32:05 +00:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2017-09-27 19:44:23 +00:00
|
|
|
/**
|
|
|
|
* 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
|
2017-11-27 21:30:49 +00:00
|
|
|
* @retval EBUSY if active references to @p provider exist; see
|
2017-09-27 19:44:23 +00:00
|
|
|
* 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
|
2017-11-27 21:30:49 +00:00
|
|
|
* (see BHND_SPF_INHERITED), the registration will also be removed, and
|
2017-09-27 19:44:23 +00:00
|
|
|
* 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.
|
2017-11-27 21:30:49 +00:00
|
|
|
*
|
|
|
|
* @see BHND_SPF_INHERITED
|
2017-09-27 19:44:23 +00:00
|
|
|
*/
|
|
|
|
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");
|
|
|
|
}
|
|
|
|
|
2016-02-26 03:34:08 +00:00
|
|
|
/**
|
2016-04-19 15:56:39 +00:00
|
|
|
* Using the bhnd(4) bus-level core information and a custom core name,
|
|
|
|
* populate @p dev's device description.
|
2016-02-26 03:34:08 +00:00
|
|
|
*
|
|
|
|
* @param dev A bhnd-bus attached device.
|
2017-11-27 21:30:49 +00:00
|
|
|
* @param dev_name The core's name (e.g. "SDIO Device Core").
|
2016-02-26 03:34:08 +00:00
|
|
|
*/
|
|
|
|
void
|
2016-04-19 15:56:39 +00:00
|
|
|
bhnd_set_custom_core_desc(device_t dev, const char *dev_name)
|
2016-02-26 03:34:08 +00:00
|
|
|
{
|
|
|
|
const char *vendor_name;
|
|
|
|
char *desc;
|
|
|
|
|
|
|
|
vendor_name = bhnd_get_vendor_name(dev);
|
2016-04-19 15:56:39 +00:00
|
|
|
asprintf(&desc, M_BHND, "%s %s, rev %hhu", vendor_name, dev_name,
|
|
|
|
bhnd_get_hwrev(dev));
|
2016-02-26 03:34:08 +00:00
|
|
|
|
|
|
|
if (desc != NULL) {
|
|
|
|
device_set_desc_copy(dev, desc);
|
|
|
|
free(desc, M_BHND);
|
|
|
|
} else {
|
|
|
|
device_set_desc(dev, dev_name);
|
|
|
|
}
|
|
|
|
}
|
2016-04-19 15:53:57 +00:00
|
|
|
|
2016-04-19 15:56:39 +00:00
|
|
|
/**
|
|
|
|
* 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));
|
|
|
|
}
|
|
|
|
|
2016-08-27 00:07:48 +00:00
|
|
|
|
|
|
|
/**
|
|
|
|
* Using the bhnd @p chip_id, populate the bhnd(4) bus @p dev's device
|
|
|
|
* description.
|
|
|
|
*
|
|
|
|
* @param dev A bhnd-bus attached device.
|
2017-11-27 21:30:49 +00:00
|
|
|
* @param chip_id The chip identification.
|
2016-08-27 00:07:48 +00:00
|
|
|
*/
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
2017-09-27 19:44:23 +00:00
|
|
|
/**
|
|
|
|
* 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);
|
|
|
|
}
|
|
|
|
|
2016-04-19 15:53:57 +00:00
|
|
|
/**
|
|
|
|
* 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()");
|
|
|
|
}
|
|
|
|
|
2017-11-21 23:25:22 +00:00
|
|
|
/**
|
|
|
|
* Helper function for implementing BHND_BUS_GET_DMA_TRANSLATION().
|
|
|
|
*
|
|
|
|
* If a parent device is available, this implementation delegates the
|
|
|
|
* request to the BHND_BUS_GET_DMA_TRANSLATION() method on the parent of @p dev.
|
|
|
|
*
|
|
|
|
* If no parent device is available, this implementation will panic.
|
|
|
|
*/
|
|
|
|
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)
|
|
|
|
{
|
|
|
|
if (device_get_parent(dev) != NULL) {
|
|
|
|
return (BHND_BUS_GET_DMA_TRANSLATION(device_get_parent(dev),
|
|
|
|
child, width, flags, dmat, translation));
|
|
|
|
}
|
|
|
|
|
|
|
|
panic("missing BHND_BUS_GET_DMA_TRANSLATION()");
|
|
|
|
}
|
|
|
|
|
2016-05-17 00:23:46 +00:00
|
|
|
/* nvram board_info population macros for bhnd_bus_generic_read_board_info() */
|
|
|
|
#define BHND_GV(_dest, _name) \
|
2016-08-16 21:32:05 +00:00
|
|
|
bhnd_nvram_getvar_uint(child, BHND_NVAR_ ## _name, &_dest, \
|
|
|
|
sizeof(_dest))
|
2016-05-17 00:23:46 +00:00
|
|
|
|
|
|
|
#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 */
|
2017-12-14 01:58:05 +00:00
|
|
|
OPT_BHND_GV(info->board_devid, DEVID, 0); /* srom >= 8 */
|
2016-05-17 00:23:46 +00:00
|
|
|
REQ_BHND_GV(info->board_rev, BOARDREV);
|
2016-08-27 00:03:02 +00:00
|
|
|
OPT_BHND_GV(info->board_srom_rev,SROMREV, 0); /* missing in
|
|
|
|
some SoC
|
|
|
|
NVRAM */
|
2016-05-17 00:23:46 +00:00
|
|
|
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().
|
|
|
|
*
|
2016-07-12 02:16:48 +00:00
|
|
|
* This implementation searches @p dev for a usable NVRAM child device.
|
2016-05-17 00:23:46 +00:00
|
|
|
*
|
|
|
|
* 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,
|
2016-08-16 21:32:05 +00:00
|
|
|
void *buf, size_t *size, bhnd_nvram_type type)
|
2016-05-17 00:23:46 +00:00
|
|
|
{
|
|
|
|
device_t nvram;
|
|
|
|
device_t parent;
|
|
|
|
|
2016-07-12 02:16:48 +00:00
|
|
|
/* 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)
|
2016-08-16 21:32:05 +00:00
|
|
|
return BHND_NVRAM_GETVAR(nvram, name, buf, size, type);
|
2016-05-17 00:23:46 +00:00
|
|
|
|
|
|
|
/* 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,
|
2016-08-16 21:32:05 +00:00
|
|
|
name, buf, size, type));
|
2016-05-17 00:23:46 +00:00
|
|
|
}
|
|
|
|
|
2016-04-19 15:53:57 +00:00
|
|
|
/**
|
|
|
|
* 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().
|
|
|
|
*
|
Implement a generic bhnd(4) device enumeration table API.
This defines a new bhnd_erom_if API, providing a common interface to device
enumeration on siba(4) and bcma(4) devices, for use both in the bhndb bridge
and SoC early boot contexts, and migrates mips/broadcom over to the new API.
This also replaces the previous adhoc device enumeration support implemented
for mips/broadcom.
Migration of bhndb to the new API will be implemented in a follow-up commit.
- Defined new bhnd_erom_if interface for bhnd(4) device enumeration, along
with bcma(4) and siba(4)-specific implementations.
- Fixed a minor bug in bhndb that logged an error when we attempted to map the
full siba(4) bus space (18000000-17FFFFFF) in the siba EROM parser.
- Reverted use of the resource's start address as the ChipCommon enum_addr in
bhnd_read_chipid(). When called from bhndb, this address is found within the
host address space, resulting in an invalid bridged enum_addr.
- Added support for falling back on standard bus_activate_resource() in
bhnd_bus_generic_activate_resource(), enabling allocation of the bhnd_erom's
bhnd_resource directly from a nexus-attached bhnd(4) device.
- Removed BHND_BUS_GET_CORE_TABLE(); it has been replaced by the erom API.
- Added support for statically initializing bhnd_erom instances, for use prior
to malloc availability. The statically allocated buffer size is verified both
at runtime, and via a compile-time assertion (see BHND_EROM_STATIC_BYTES).
- bhnd_erom classes are registered within a module via a linker set, allowing
mips/broadcom to probe available EROM parser instances without creating a
strong reference to bcma/siba-specific symbols.
- Migrated mips/broadcom to bhnd_erom_if, replacing the previous MIPS-specific
device enumeration implementation.
Approved by: adrian (mentor)
Differential Revision: https://reviews.freebsd.org/D7748
2016-09-03 23:57:17 +00:00
|
|
|
* This implementation of BHND_BUS_ACTIVATE_RESOURCE() first calls the
|
2016-04-19 15:53:57 +00:00
|
|
|
* BHND_BUS_ACTIVATE_RESOURCE() method of the parent of @p dev.
|
Implement a generic bhnd(4) device enumeration table API.
This defines a new bhnd_erom_if API, providing a common interface to device
enumeration on siba(4) and bcma(4) devices, for use both in the bhndb bridge
and SoC early boot contexts, and migrates mips/broadcom over to the new API.
This also replaces the previous adhoc device enumeration support implemented
for mips/broadcom.
Migration of bhndb to the new API will be implemented in a follow-up commit.
- Defined new bhnd_erom_if interface for bhnd(4) device enumeration, along
with bcma(4) and siba(4)-specific implementations.
- Fixed a minor bug in bhndb that logged an error when we attempted to map the
full siba(4) bus space (18000000-17FFFFFF) in the siba EROM parser.
- Reverted use of the resource's start address as the ChipCommon enum_addr in
bhnd_read_chipid(). When called from bhndb, this address is found within the
host address space, resulting in an invalid bridged enum_addr.
- Added support for falling back on standard bus_activate_resource() in
bhnd_bus_generic_activate_resource(), enabling allocation of the bhnd_erom's
bhnd_resource directly from a nexus-attached bhnd(4) device.
- Removed BHND_BUS_GET_CORE_TABLE(); it has been replaced by the erom API.
- Added support for statically initializing bhnd_erom instances, for use prior
to malloc availability. The statically allocated buffer size is verified both
at runtime, and via a compile-time assertion (see BHND_EROM_STATIC_BYTES).
- bhnd_erom classes are registered within a module via a linker set, allowing
mips/broadcom to probe available EROM parser instances without creating a
strong reference to bcma/siba-specific symbols.
- Migrated mips/broadcom to bhnd_erom_if, replacing the previous MIPS-specific
device enumeration implementation.
Approved by: adrian (mentor)
Differential Revision: https://reviews.freebsd.org/D7748
2016-09-03 23:57:17 +00:00
|
|
|
*
|
|
|
|
* 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.
|
2016-04-19 15:53:57 +00:00
|
|
|
*/
|
|
|
|
int
|
|
|
|
bhnd_bus_generic_activate_resource(device_t dev, device_t child, int type,
|
|
|
|
int rid, struct bhnd_resource *r)
|
|
|
|
{
|
Implement a generic bhnd(4) device enumeration table API.
This defines a new bhnd_erom_if API, providing a common interface to device
enumeration on siba(4) and bcma(4) devices, for use both in the bhndb bridge
and SoC early boot contexts, and migrates mips/broadcom over to the new API.
This also replaces the previous adhoc device enumeration support implemented
for mips/broadcom.
Migration of bhndb to the new API will be implemented in a follow-up commit.
- Defined new bhnd_erom_if interface for bhnd(4) device enumeration, along
with bcma(4) and siba(4)-specific implementations.
- Fixed a minor bug in bhndb that logged an error when we attempted to map the
full siba(4) bus space (18000000-17FFFFFF) in the siba EROM parser.
- Reverted use of the resource's start address as the ChipCommon enum_addr in
bhnd_read_chipid(). When called from bhndb, this address is found within the
host address space, resulting in an invalid bridged enum_addr.
- Added support for falling back on standard bus_activate_resource() in
bhnd_bus_generic_activate_resource(), enabling allocation of the bhnd_erom's
bhnd_resource directly from a nexus-attached bhnd(4) device.
- Removed BHND_BUS_GET_CORE_TABLE(); it has been replaced by the erom API.
- Added support for statically initializing bhnd_erom instances, for use prior
to malloc availability. The statically allocated buffer size is verified both
at runtime, and via a compile-time assertion (see BHND_EROM_STATIC_BYTES).
- bhnd_erom classes are registered within a module via a linker set, allowing
mips/broadcom to probe available EROM parser instances without creating a
strong reference to bcma/siba-specific symbols.
- Migrated mips/broadcom to bhnd_erom_if, replacing the previous MIPS-specific
device enumeration implementation.
Approved by: adrian (mentor)
Differential Revision: https://reviews.freebsd.org/D7748
2016-09-03 23:57:17 +00:00
|
|
|
int error;
|
|
|
|
bool passthrough;
|
|
|
|
|
|
|
|
passthrough = (device_get_parent(child) != dev);
|
|
|
|
|
2016-04-19 15:53:57 +00:00
|
|
|
/* Try to delegate to the parent */
|
Implement a generic bhnd(4) device enumeration table API.
This defines a new bhnd_erom_if API, providing a common interface to device
enumeration on siba(4) and bcma(4) devices, for use both in the bhndb bridge
and SoC early boot contexts, and migrates mips/broadcom over to the new API.
This also replaces the previous adhoc device enumeration support implemented
for mips/broadcom.
Migration of bhndb to the new API will be implemented in a follow-up commit.
- Defined new bhnd_erom_if interface for bhnd(4) device enumeration, along
with bcma(4) and siba(4)-specific implementations.
- Fixed a minor bug in bhndb that logged an error when we attempted to map the
full siba(4) bus space (18000000-17FFFFFF) in the siba EROM parser.
- Reverted use of the resource's start address as the ChipCommon enum_addr in
bhnd_read_chipid(). When called from bhndb, this address is found within the
host address space, resulting in an invalid bridged enum_addr.
- Added support for falling back on standard bus_activate_resource() in
bhnd_bus_generic_activate_resource(), enabling allocation of the bhnd_erom's
bhnd_resource directly from a nexus-attached bhnd(4) device.
- Removed BHND_BUS_GET_CORE_TABLE(); it has been replaced by the erom API.
- Added support for statically initializing bhnd_erom instances, for use prior
to malloc availability. The statically allocated buffer size is verified both
at runtime, and via a compile-time assertion (see BHND_EROM_STATIC_BYTES).
- bhnd_erom classes are registered within a module via a linker set, allowing
mips/broadcom to probe available EROM parser instances without creating a
strong reference to bcma/siba-specific symbols.
- Migrated mips/broadcom to bhnd_erom_if, replacing the previous MIPS-specific
device enumeration implementation.
Approved by: adrian (mentor)
Differential Revision: https://reviews.freebsd.org/D7748
2016-09-03 23:57:17 +00:00
|
|
|
if (device_get_parent(dev) != NULL) {
|
|
|
|
error = BHND_BUS_ACTIVATE_RESOURCE(device_get_parent(dev),
|
|
|
|
child, type, rid, r);
|
|
|
|
} else {
|
|
|
|
error = ENODEV;
|
|
|
|
}
|
2016-04-19 15:53:57 +00:00
|
|
|
|
Implement a generic bhnd(4) device enumeration table API.
This defines a new bhnd_erom_if API, providing a common interface to device
enumeration on siba(4) and bcma(4) devices, for use both in the bhndb bridge
and SoC early boot contexts, and migrates mips/broadcom over to the new API.
This also replaces the previous adhoc device enumeration support implemented
for mips/broadcom.
Migration of bhndb to the new API will be implemented in a follow-up commit.
- Defined new bhnd_erom_if interface for bhnd(4) device enumeration, along
with bcma(4) and siba(4)-specific implementations.
- Fixed a minor bug in bhndb that logged an error when we attempted to map the
full siba(4) bus space (18000000-17FFFFFF) in the siba EROM parser.
- Reverted use of the resource's start address as the ChipCommon enum_addr in
bhnd_read_chipid(). When called from bhndb, this address is found within the
host address space, resulting in an invalid bridged enum_addr.
- Added support for falling back on standard bus_activate_resource() in
bhnd_bus_generic_activate_resource(), enabling allocation of the bhnd_erom's
bhnd_resource directly from a nexus-attached bhnd(4) device.
- Removed BHND_BUS_GET_CORE_TABLE(); it has been replaced by the erom API.
- Added support for statically initializing bhnd_erom instances, for use prior
to malloc availability. The statically allocated buffer size is verified both
at runtime, and via a compile-time assertion (see BHND_EROM_STATIC_BYTES).
- bhnd_erom classes are registered within a module via a linker set, allowing
mips/broadcom to probe available EROM parser instances without creating a
strong reference to bcma/siba-specific symbols.
- Migrated mips/broadcom to bhnd_erom_if, replacing the previous MIPS-specific
device enumeration implementation.
Approved by: adrian (mentor)
Differential Revision: https://reviews.freebsd.org/D7748
2016-09-03 23:57:17 +00:00
|
|
|
/* 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);
|
2016-09-06 13:34:10 +00:00
|
|
|
}
|
2016-04-19 15:53:57 +00:00
|
|
|
|
|
|
|
/**
|
|
|
|
* 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);
|
2016-09-06 13:34:10 +00:00
|
|
|
}
|
2016-06-04 19:31:06 +00:00
|
|
|
|
2017-11-21 23:15:20 +00:00
|
|
|
/**
|
|
|
|
* Helper function for implementing BHND_BUS_GET_INTR_DOMAIN().
|
|
|
|
*
|
|
|
|
* This implementation simply returns the address of nearest bhnd(4) bus,
|
|
|
|
* which may be @p dev; this behavior may be incompatible with FDT/OFW targets.
|
|
|
|
*/
|
|
|
|
uintptr_t
|
|
|
|
bhnd_bus_generic_get_intr_domain(device_t dev, device_t child, bool self)
|
|
|
|
{
|
|
|
|
return ((uintptr_t)dev);
|
2017-11-22 20:27:46 +00:00
|
|
|
}
|