55aaf894e8
support machines having multiple independently numbered PCI domains and don't support reenumeration without ambiguity amongst the devices as seen by the OS and represented by PCI location strings. This includes introducing a function pci_find_dbsf(9) which works like pci_find_bsf(9) but additionally takes a domain number argument and limiting pci_find_bsf(9) to only search devices in domain 0 (the only domain in single-domain systems). Bge(4) and ofw_pcibus(4) are changed to use pci_find_dbsf(9) instead of pci_find_bsf(9) in order to no longer report false positives when searching for siblings and dupe devices in the same domain respectively. Along with this change the sole host-PCI bridge driver converted to actually make use of PCI domain support is uninorth(4), the others continue to use domain 0 only for now and need to be converted as appropriate later on. Note that this means that the format of the location strings as used by pciconf(8) has been changed and that consumers of <sys/pciio.h> potentially need to be recompiled. Suggested by: jhb Reviewed by: grehan, jhb, marcel Approved by: re (kensmith), jhb (PCI maintainer hat)
369 lines
10 KiB
C
369 lines
10 KiB
C
/*-
|
|
* Copyright (c) 2003 M. Warner Losh. All Rights Reserved.
|
|
* Copyright (c) 2000,2001 Jonathan Chen. All rights reserved.
|
|
*
|
|
* 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.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, 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 DAMAGE.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/module.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/sysctl.h>
|
|
|
|
#include <sys/bus.h>
|
|
#include <machine/bus.h>
|
|
#include <sys/rman.h>
|
|
#include <machine/resource.h>
|
|
|
|
#include <sys/pciio.h>
|
|
#include <dev/pci/pcivar.h>
|
|
#include <dev/pci/pcireg.h>
|
|
#include <dev/pci/pci_private.h>
|
|
|
|
#include <dev/cardbus/cardbusreg.h>
|
|
#include <dev/cardbus/cardbusvar.h>
|
|
#include <dev/cardbus/cardbus_cis.h>
|
|
#include <dev/pccard/pccard_cis.h>
|
|
#include <dev/pccard/pccardvar.h>
|
|
|
|
#include "power_if.h"
|
|
#include "pcib_if.h"
|
|
|
|
/* sysctl vars */
|
|
SYSCTL_NODE(_hw, OID_AUTO, cardbus, CTLFLAG_RD, 0, "CardBus parameters");
|
|
|
|
int cardbus_debug = 0;
|
|
TUNABLE_INT("hw.cardbus.debug", &cardbus_debug);
|
|
SYSCTL_INT(_hw_cardbus, OID_AUTO, debug, CTLFLAG_RW,
|
|
&cardbus_debug, 0,
|
|
"CardBus debug");
|
|
|
|
int cardbus_cis_debug = 0;
|
|
TUNABLE_INT("hw.cardbus.cis_debug", &cardbus_cis_debug);
|
|
SYSCTL_INT(_hw_cardbus, OID_AUTO, cis_debug, CTLFLAG_RW,
|
|
&cardbus_cis_debug, 0,
|
|
"CardBus CIS debug");
|
|
|
|
#define DPRINTF(a) if (cardbus_debug) printf a
|
|
#define DEVPRINTF(x) if (cardbus_debug) device_printf x
|
|
|
|
static int cardbus_attach(device_t cbdev);
|
|
static int cardbus_attach_card(device_t cbdev);
|
|
static int cardbus_detach(device_t cbdev);
|
|
static int cardbus_detach_card(device_t cbdev);
|
|
static void cardbus_device_setup_regs(pcicfgregs *cfg);
|
|
static void cardbus_driver_added(device_t cbdev, driver_t *driver);
|
|
static int cardbus_probe(device_t cbdev);
|
|
static int cardbus_read_ivar(device_t cbdev, device_t child, int which,
|
|
uintptr_t *result);
|
|
static void cardbus_release_all_resources(device_t cbdev,
|
|
struct cardbus_devinfo *dinfo);
|
|
static int cardbus_write_ivar(device_t cbdev, device_t child, int which,
|
|
uintptr_t value);
|
|
|
|
/************************************************************************/
|
|
/* Probe/Attach */
|
|
/************************************************************************/
|
|
|
|
static int
|
|
cardbus_probe(device_t cbdev)
|
|
{
|
|
device_set_desc(cbdev, "CardBus bus");
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
cardbus_attach(device_t cbdev)
|
|
{
|
|
struct cardbus_softc *sc = device_get_softc(cbdev);
|
|
|
|
sc->sc_dev = cbdev;
|
|
cardbus_device_create(sc);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
cardbus_detach(device_t cbdev)
|
|
{
|
|
struct cardbus_softc *sc = device_get_softc(cbdev);
|
|
|
|
cardbus_detach_card(cbdev);
|
|
cardbus_device_destroy(sc);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
cardbus_suspend(device_t self)
|
|
{
|
|
|
|
cardbus_detach_card(self);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
cardbus_resume(device_t self)
|
|
{
|
|
|
|
return (0);
|
|
}
|
|
|
|
/************************************************************************/
|
|
/* Attach/Detach card */
|
|
/************************************************************************/
|
|
|
|
static void
|
|
cardbus_device_setup_regs(pcicfgregs *cfg)
|
|
{
|
|
device_t dev = cfg->dev;
|
|
int i;
|
|
|
|
/*
|
|
* Some cards power up with garbage in their BARs. This
|
|
* code clears all that junk out.
|
|
*/
|
|
for (i = 0; i < PCI_MAX_BAR_0; i++)
|
|
pci_write_config(dev, PCIR_BAR(i), 0, 4);
|
|
|
|
cfg->intline =
|
|
pci_get_irq(device_get_parent(device_get_parent(dev)));
|
|
pci_write_config(dev, PCIR_INTLINE, cfg->intline, 1);
|
|
pci_write_config(dev, PCIR_CACHELNSZ, 0x08, 1);
|
|
pci_write_config(dev, PCIR_LATTIMER, 0xa8, 1);
|
|
pci_write_config(dev, PCIR_MINGNT, 0x14, 1);
|
|
pci_write_config(dev, PCIR_MAXLAT, 0x14, 1);
|
|
}
|
|
|
|
static int
|
|
cardbus_attach_card(device_t cbdev)
|
|
{
|
|
device_t brdev = device_get_parent(cbdev);
|
|
device_t child;
|
|
int bus, domain, slot, func;
|
|
int cardattached = 0;
|
|
int cardbusfunchigh = 0;
|
|
|
|
cardbus_detach_card(cbdev); /* detach existing cards */
|
|
POWER_ENABLE_SOCKET(brdev, cbdev);
|
|
domain = pcib_get_domain(cbdev);
|
|
bus = pcib_get_bus(cbdev);
|
|
slot = 0;
|
|
/* For each function, set it up and try to attach a driver to it */
|
|
for (func = 0; func <= cardbusfunchigh; func++) {
|
|
struct cardbus_devinfo *dinfo;
|
|
|
|
dinfo = (struct cardbus_devinfo *)
|
|
pci_read_device(brdev, domain, bus, slot, func,
|
|
sizeof(struct cardbus_devinfo));
|
|
if (dinfo == NULL)
|
|
continue;
|
|
if (dinfo->pci.cfg.mfdev)
|
|
cardbusfunchigh = PCI_FUNCMAX;
|
|
|
|
child = device_add_child(cbdev, NULL, -1);
|
|
if (child == NULL) {
|
|
DEVPRINTF((cbdev, "Cannot add child!\n"));
|
|
pci_freecfg((struct pci_devinfo *)dinfo);
|
|
continue;
|
|
}
|
|
dinfo->pci.cfg.dev = child;
|
|
resource_list_init(&dinfo->pci.resources);
|
|
device_set_ivars(child, dinfo);
|
|
if (cardbus_do_cis(cbdev, child) != 0)
|
|
DEVPRINTF((cbdev, "Warning: Bogus CIS ignored\n"));
|
|
pci_cfg_save(dinfo->pci.cfg.dev, &dinfo->pci, 0);
|
|
pci_cfg_restore(dinfo->pci.cfg.dev, &dinfo->pci);
|
|
cardbus_device_setup_regs(&dinfo->pci.cfg);
|
|
pci_add_resources(cbdev, child, 1, dinfo->mprefetchable);
|
|
pci_print_verbose(&dinfo->pci);
|
|
if (device_probe_and_attach(child) == 0)
|
|
cardattached++;
|
|
else
|
|
pci_cfg_save(dinfo->pci.cfg.dev, &dinfo->pci, 1);
|
|
}
|
|
if (cardattached > 0)
|
|
return (0);
|
|
POWER_DISABLE_SOCKET(brdev, cbdev);
|
|
return (ENOENT);
|
|
}
|
|
|
|
static int
|
|
cardbus_detach_card(device_t cbdev)
|
|
{
|
|
int numdevs;
|
|
device_t *devlist;
|
|
int tmp;
|
|
int err = 0;
|
|
|
|
if (device_get_children(cbdev, &devlist, &numdevs) != 0)
|
|
return (ENOENT);
|
|
|
|
if (numdevs == 0) {
|
|
free(devlist, M_TEMP);
|
|
return (ENOENT);
|
|
}
|
|
|
|
for (tmp = 0; tmp < numdevs; tmp++) {
|
|
struct cardbus_devinfo *dinfo = device_get_ivars(devlist[tmp]);
|
|
int status = device_get_state(devlist[tmp]);
|
|
|
|
if (dinfo->pci.cfg.dev != devlist[tmp])
|
|
device_printf(cbdev, "devinfo dev mismatch\n");
|
|
if (status == DS_ATTACHED || status == DS_BUSY)
|
|
device_detach(devlist[tmp]);
|
|
cardbus_release_all_resources(cbdev, dinfo);
|
|
device_delete_child(cbdev, devlist[tmp]);
|
|
pci_freecfg((struct pci_devinfo *)dinfo);
|
|
}
|
|
POWER_DISABLE_SOCKET(device_get_parent(cbdev), cbdev);
|
|
free(devlist, M_TEMP);
|
|
return (err);
|
|
}
|
|
|
|
static void
|
|
cardbus_driver_added(device_t cbdev, driver_t *driver)
|
|
{
|
|
int numdevs;
|
|
device_t *devlist;
|
|
device_t dev;
|
|
int i;
|
|
struct cardbus_devinfo *dinfo;
|
|
|
|
DEVICE_IDENTIFY(driver, cbdev);
|
|
if (device_get_children(cbdev, &devlist, &numdevs) != 0)
|
|
return;
|
|
|
|
/*
|
|
* If there are no drivers attached, but there are children,
|
|
* then power the card up.
|
|
*/
|
|
for (i = 0; i < numdevs; i++) {
|
|
dev = devlist[i];
|
|
if (device_get_state(dev) != DS_NOTPRESENT)
|
|
break;
|
|
}
|
|
if (i > 0 && i == numdevs)
|
|
POWER_ENABLE_SOCKET(device_get_parent(cbdev), cbdev);
|
|
for (i = 0; i < numdevs; i++) {
|
|
dev = devlist[i];
|
|
if (device_get_state(dev) != DS_NOTPRESENT)
|
|
continue;
|
|
dinfo = device_get_ivars(dev);
|
|
pci_print_verbose(&dinfo->pci);
|
|
pci_cfg_restore(dinfo->pci.cfg.dev, &dinfo->pci);
|
|
if (device_probe_and_attach(dev) != 0)
|
|
pci_cfg_save(dev, &dinfo->pci, 1);
|
|
}
|
|
free(devlist, M_TEMP);
|
|
}
|
|
|
|
static void
|
|
cardbus_release_all_resources(device_t cbdev, struct cardbus_devinfo *dinfo)
|
|
{
|
|
struct resource_list_entry *rle;
|
|
|
|
/* Free all allocated resources */
|
|
STAILQ_FOREACH(rle, &dinfo->pci.resources, link) {
|
|
if (rle->res) {
|
|
BUS_RELEASE_RESOURCE(device_get_parent(cbdev),
|
|
cbdev, rle->type, rle->rid, rle->res);
|
|
rle->res = NULL;
|
|
/*
|
|
* zero out config so the card won't acknowledge
|
|
* access to the space anymore. XXX doesn't handle
|
|
* 64-bit bars.
|
|
*/
|
|
pci_write_config(dinfo->pci.cfg.dev, rle->rid, 0, 4);
|
|
}
|
|
}
|
|
resource_list_free(&dinfo->pci.resources);
|
|
}
|
|
|
|
/************************************************************************/
|
|
/* Other Bus Methods */
|
|
/************************************************************************/
|
|
|
|
static int
|
|
cardbus_read_ivar(device_t cbdev, device_t child, int which, uintptr_t *result)
|
|
{
|
|
struct cardbus_devinfo *dinfo;
|
|
pcicfgregs *cfg;
|
|
|
|
dinfo = device_get_ivars(child);
|
|
cfg = &dinfo->pci.cfg;
|
|
|
|
switch (which) {
|
|
case PCI_IVAR_ETHADDR:
|
|
/*
|
|
* The generic accessor doesn't deal with failure, so
|
|
* we set the return value, then return an error.
|
|
*/
|
|
if (dinfo->fepresent & (1 << PCCARD_TPLFE_TYPE_LAN_NID)) {
|
|
*((uint8_t **) result) = dinfo->funce.lan.nid;
|
|
break;
|
|
}
|
|
*((uint8_t **) result) = NULL;
|
|
return (EINVAL);
|
|
default:
|
|
return (pci_read_ivar(cbdev, child, which, result));
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
cardbus_write_ivar(device_t cbdev, device_t child, int which, uintptr_t value)
|
|
{
|
|
return(pci_write_ivar(cbdev, child, which, value));
|
|
}
|
|
|
|
static device_method_t cardbus_methods[] = {
|
|
/* Device interface */
|
|
DEVMETHOD(device_probe, cardbus_probe),
|
|
DEVMETHOD(device_attach, cardbus_attach),
|
|
DEVMETHOD(device_detach, cardbus_detach),
|
|
DEVMETHOD(device_suspend, cardbus_suspend),
|
|
DEVMETHOD(device_resume, cardbus_resume),
|
|
|
|
/* Bus interface */
|
|
DEVMETHOD(bus_read_ivar, cardbus_read_ivar),
|
|
DEVMETHOD(bus_write_ivar, cardbus_write_ivar),
|
|
DEVMETHOD(bus_driver_added, cardbus_driver_added),
|
|
|
|
/* Card Interface */
|
|
DEVMETHOD(card_attach_card, cardbus_attach_card),
|
|
DEVMETHOD(card_detach_card, cardbus_detach_card),
|
|
|
|
{0,0}
|
|
};
|
|
|
|
DEFINE_CLASS_1(cardbus, cardbus_driver, cardbus_methods,
|
|
sizeof(struct cardbus_softc), pci_driver);
|
|
|
|
static devclass_t cardbus_devclass;
|
|
|
|
DRIVER_MODULE(cardbus, cbb, cardbus_driver, cardbus_devclass, 0, 0);
|
|
MODULE_VERSION(cardbus, 1);
|