root/sys/dev/cardbus/cardbus.c
/*-
 * SPDX-License-Identifier: BSD-2-Clause
 *
 * Copyright (c) 2000,2001 Jonathan Chen.  All rights reserved.
 * Copyright (c) 2003-2008 M. Warner Losh <imp@FreeBSD.org>
 *
 * 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/param.h>
#include <sys/eventhandler.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 */
static SYSCTL_NODE(_hw, OID_AUTO, cardbus, CTLFLAG_RD | CTLFLAG_MPSAFE, 0,
    "CardBus parameters");

int    cardbus_debug = 0;
SYSCTL_INT(_hw_cardbus, OID_AUTO, debug, CTLFLAG_RWTUN,
    &cardbus_debug, 0, "CardBus debug");

int    cardbus_cis_debug = 0;
SYSCTL_INT(_hw_cardbus, OID_AUTO, cis_debug, CTLFLAG_RWTUN,
    &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);

/************************************************************************/
/* 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;
        int rid;

        sc = device_get_softc(cbdev);
        sc->sc_dev = cbdev;
        rid = 0;
        sc->sc_bus = bus_alloc_resource(cbdev, PCI_RES_BUS, &rid,
            pcib_get_bus(cbdev), pcib_get_bus(cbdev), 1, 0);
        if (sc->sc_bus == NULL) {
                device_printf(cbdev, "failed to allocate bus number\n");
                return (ENXIO);
        }
        return (0);
}

static int
cardbus_detach(device_t cbdev)
{
        struct cardbus_softc *sc;

        cardbus_detach_card(cbdev);
        sc = device_get_softc(cbdev);
        device_printf(cbdev, "Freeing up the allocatd bus\n");
        (void)bus_release_resource(cbdev, PCI_RES_BUS, 0, sc->sc_bus);
        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 < PCIR_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 struct pci_devinfo *
cardbus_alloc_devinfo(device_t dev)
{
        struct cardbus_devinfo *dinfo;

        dinfo = malloc(sizeof(*dinfo), M_DEVBUF, M_WAITOK | M_ZERO);
        return (&dinfo->pci);
}

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;
        struct cardbus_softc *sc;

        sc = device_get_softc(cbdev);
        cardbus_detach_card(cbdev); /* detach existing cards */
        POWER_DISABLE_SOCKET(brdev, cbdev); /* Turn the socket off first */
        POWER_ENABLE_SOCKET(brdev, cbdev);
        domain = pcib_get_domain(cbdev);
        bus = pcib_get_bus(cbdev);
        slot = 0;
        bus_topo_lock();
        /* 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, cbdev, domain, bus, slot, func);
                if (dinfo == NULL)
                        continue;
                if (dinfo->pci.cfg.mfdev)
                        cardbusfunchigh = PCI_FUNCMAX;

                child = device_add_child(cbdev, NULL, DEVICE_UNIT_ANY);
                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);
                cardbus_device_create(sc, dinfo, cbdev, child);
                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);
                pci_clear_pme(child);
                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);
        }
        bus_topo_unlock();
        if (cardattached > 0)
                return (0);
/*      POWER_DISABLE_SOCKET(brdev, cbdev); */
        return (ENOENT);
}

static void
cardbus_child_deleted(device_t cbdev, device_t child)
{
        struct cardbus_devinfo *dinfo = device_get_ivars(child);

        if (dinfo->pci.cfg.dev != child)
                device_printf(cbdev, "devinfo dev mismatch\n");
        cardbus_device_destroy(dinfo);
        pci_child_deleted(cbdev, child);
}

static int
cardbus_detach_card(device_t cbdev)
{
        int err = 0;

        bus_topo_lock();
        err = bus_generic_detach(cbdev);
        bus_topo_unlock();
        if (err)
                return (err);

        POWER_DISABLE_SOCKET(device_get_parent(cbdev), cbdev);
        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);
                if (bootverbose)
                        printf("pci%d:%d:%d:%d: reprobing on driver added\n",
                            dinfo->pci.cfg.domain, dinfo->pci.cfg.bus,
                            dinfo->pci.cfg.slot, dinfo->pci.cfg.func);
                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);
}

/************************************************************************/
/* Other Bus Methods                                                    */
/************************************************************************/

static int
cardbus_read_ivar(device_t cbdev, device_t child, int which, uintptr_t *result)
{
        struct cardbus_devinfo *dinfo;

        dinfo = device_get_ivars(child);

        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 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_child_deleted,    cardbus_child_deleted),
        DEVMETHOD(bus_get_dma_tag,      bus_generic_get_dma_tag),
        DEVMETHOD(bus_read_ivar,        cardbus_read_ivar),
        DEVMETHOD(bus_driver_added,     cardbus_driver_added),
        DEVMETHOD(bus_rescan,           bus_null_rescan),

        /* Card Interface */
        DEVMETHOD(card_attach_card,     cardbus_attach_card),
        DEVMETHOD(card_detach_card,     cardbus_detach_card),

        /* PCI interface */
        DEVMETHOD(pci_alloc_devinfo,    cardbus_alloc_devinfo),
        {0,0}
};

DEFINE_CLASS_1(cardbus, cardbus_driver, cardbus_methods,
    sizeof(struct cardbus_softc), pci_driver);

DRIVER_MODULE(cardbus, cbb, cardbus_driver, 0, 0);
MODULE_VERSION(cardbus, 1);