root/sys/dev/firewire/fwohci_pci.c
/*-
 * SPDX-License-Identifier: BSD-4-Clause
 *
 * Copyright (c) 2003 Hidetoshi Shimokawa
 * Copyright (c) 1998-2002 Katsushi Kobayashi and Hidetoshi Shimokawa
 * 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.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the acknowledgement as bellow:
 *
 *    This product includes software developed by K. Kobayashi and H. SHimokawa
 *
 * 4. The name of the author may not be used to endorse or promote products
 *    derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 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>
#define BOUNCE_BUFFER_TEST      0

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/bus.h>
#include <sys/queue.h>
#include <machine/bus.h>
#include <sys/rman.h>
#include <sys/malloc.h>
#include <sys/lock.h>
#include <sys/mutex.h>
#include <machine/resource.h>

#include <dev/pci/pcivar.h>
#include <dev/pci/pcireg.h>

#include <dev/firewire/firewire.h>
#include <dev/firewire/firewirereg.h>

#include <dev/firewire/fwdma.h>
#include <dev/firewire/fwohcireg.h>
#include <dev/firewire/fwohcivar.h>

static int fwohci_pci_attach(device_t self);
static int fwohci_pci_detach(device_t self);

/*
 * The probe routine.
 */
static int
fwohci_pci_probe(device_t dev)
{
        uint32_t id;

        id = pci_get_devid(dev);
        if (id == (FW_VENDORID_NATSEMI | FW_DEVICE_CS4210)) {
                device_set_desc(dev, "National Semiconductor CS4210");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_NEC | FW_DEVICE_UPD861)) {
                device_set_desc(dev, "NEC uPD72861");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_NEC | FW_DEVICE_UPD871)) {
                device_set_desc(dev, "NEC uPD72871/2");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_NEC | FW_DEVICE_UPD72870)) {
                device_set_desc(dev, "NEC uPD72870");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_NEC | FW_DEVICE_UPD72873)) {
                device_set_desc(dev, "NEC uPD72873");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_NEC | FW_DEVICE_UPD72874)) {
                device_set_desc(dev, "NEC uPD72874");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_SIS | FW_DEVICE_7007)) {
                /* It has no real identifier, using device id. */
                device_set_desc(dev, "SiS 7007");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TITSB22)) {
                device_set_desc(dev, "Texas Instruments TSB12LV22");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TITSB23)) {
                device_set_desc(dev, "Texas Instruments TSB12LV23");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TITSB26)) {
                device_set_desc(dev, "Texas Instruments TSB12LV26");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TITSB43)) {
                device_set_desc(dev, "Texas Instruments TSB43AA22");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TITSB43A)) {
                device_set_desc(dev, "Texas Instruments TSB43AB22/A");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TITSB43AB21)) {
                device_set_desc(dev, "Texas Instruments TSB43AB21/A/AI/A-EP");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TITSB43AB23)) {
                device_set_desc(dev, "Texas Instruments TSB43AB23");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TITSB82AA2)) {
                device_set_desc(dev, "Texas Instruments TSB82AA2");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TIPCI4450)) {
                device_set_desc(dev, "Texas Instruments PCI4450");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TIPCI4410A)) {
                device_set_desc(dev, "Texas Instruments PCI4410A");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_TI | FW_DEVICE_TIPCI4451)) {
                device_set_desc(dev, "Texas Instruments PCI4451");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_SONY | FW_DEVICE_CXD1947)) {
                device_printf(dev, "Sony i.LINK (CXD1947) not supported\n");
                return ENXIO;
        }
        if (id == (FW_VENDORID_SONY | FW_DEVICE_CXD3222)) {
                device_set_desc(dev, "Sony i.LINK (CXD3222)");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_VIA | FW_DEVICE_VT6306)) {
                device_set_desc(dev, "VIA Fire II (VT6306)");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_RICOH | FW_DEVICE_R5C551)) {
                device_set_desc(dev, "Ricoh R5C551");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_RICOH | FW_DEVICE_R5C552)) {
                device_set_desc(dev, "Ricoh R5C552");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_APPLE | FW_DEVICE_PANGEA)) {
                device_set_desc(dev, "Apple Pangea");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_APPLE | FW_DEVICE_UNINORTH2)) {
                device_set_desc(dev, "Apple UniNorth 2");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_LUCENT | FW_DEVICE_FW322)) {
                device_set_desc(dev, "Lucent FW322/323");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_INTEL | FW_DEVICE_82372FB)) {
                device_set_desc(dev, "Intel 82372FB");
                return BUS_PROBE_DEFAULT;
        }
        if (id == (FW_VENDORID_ADAPTEC | FW_DEVICE_AIC5800)) {
                device_set_desc(dev, "Adaptec AHA-894x/AIC-5800");
                return BUS_PROBE_DEFAULT;
        }
        if (pci_get_class(dev) == PCIC_SERIALBUS
                        && pci_get_subclass(dev) == PCIS_SERIALBUS_FW
                        && pci_get_progif(dev) == PCI_INTERFACE_OHCI) {
                if (bootverbose)
                        device_printf(dev, "vendor=%x, dev=%x\n",
                            pci_get_vendor(dev), pci_get_device(dev));
                device_set_desc(dev, "1394 Open Host Controller Interface");
                return BUS_PROBE_DEFAULT;
        }

        return ENXIO;
}

static int
fwohci_pci_init(device_t self)
{
        int olatency, latency, ocache_line, cache_line;
        uint16_t cmd;

        cmd = pci_read_config(self, PCIR_COMMAND, 2);
        cmd |= PCIM_CMD_BUSMASTEREN | PCIM_CMD_MWRICEN;
#if 1  /* for broken hardware */
        cmd &= ~PCIM_CMD_MWRICEN;
#endif
        pci_write_config(self, PCIR_COMMAND, cmd, 2);

        latency = olatency = pci_read_config(self, PCIR_LATTIMER, 1);
#define DEF_LATENCY 0x20
        if (olatency < DEF_LATENCY) {
                latency = DEF_LATENCY;
                pci_write_config(self, PCIR_LATTIMER, latency, 1);
        }

        cache_line = ocache_line = pci_read_config(self, PCIR_CACHELNSZ, 1);
#define DEF_CACHE_LINE 8
        if (ocache_line < DEF_CACHE_LINE) {
                cache_line = DEF_CACHE_LINE;
                pci_write_config(self, PCIR_CACHELNSZ, cache_line, 1);
        }

        if (firewire_debug) {
                device_printf(self, "latency timer %d -> %d.\n",
                        olatency, latency);
                device_printf(self, "cache size %d -> %d.\n",
                        ocache_line, cache_line);
        }

        return 0;
}

static int
fwohci_pci_attach(device_t self)
{
        fwohci_softc_t *sc = device_get_softc(self);
        int err;
        int rid;

#if 0
        if (bootverbose)
                firewire_debug = bootverbose;
#endif

        mtx_init(FW_GMTX(&sc->fc), "firewire", NULL, MTX_DEF);
        fwohci_pci_init(self);

        rid = PCI_CBMEM;
        sc->bsr = bus_alloc_resource_any(self, SYS_RES_MEMORY, &rid, RF_ACTIVE);
        if (!sc->bsr) {
                device_printf(self, "Could not map memory\n");
                return ENXIO;
        }

        sc->bst = rman_get_bustag(sc->bsr);
        sc->bsh = rman_get_bushandle(sc->bsr);

        rid = 0;
        sc->irq_res = bus_alloc_resource_any(self, SYS_RES_IRQ, &rid,
                                     RF_SHAREABLE | RF_ACTIVE);
        if (sc->irq_res == NULL) {
                device_printf(self, "Could not allocate irq\n");
                fwohci_pci_detach(self);
                return ENXIO;
        }

        err = bus_setup_intr(self, sc->irq_res,
                                INTR_TYPE_NET | INTR_MPSAFE,
                                NULL, (driver_intr_t *) fwohci_intr,
                                sc, &sc->ih);

        if (err) {
                device_printf(self, "Could not setup irq, %d\n", err);
                fwohci_pci_detach(self);
                return ENXIO;
        }

        err = bus_dma_tag_create(
                                /*parent*/bus_get_dma_tag(self),
                                /*alignment*/1,
                                /*boundary*/0,
#if BOUNCE_BUFFER_TEST
                                /*lowaddr*/BUS_SPACE_MAXADDR_24BIT,
#else
                                /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
#endif
                                /*highaddr*/BUS_SPACE_MAXADDR,
                                /*filter*/NULL, /*filterarg*/NULL,
                                /*maxsize*/0x100000,
                                /*nsegments*/0x20,
                                /*maxsegsz*/0x8000,
                                /*flags*/BUS_DMA_ALLOCNOW,
                                /*lockfunc*/busdma_lock_mutex,
                                /*lockarg*/FW_GMTX(&sc->fc),
                                &sc->fc.dmat);
        if (err != 0) {
                device_printf(self, "fwohci_pci_attach: Could not allocate DMA "
                    "tag - error %d\n", err);
                fwohci_pci_detach(self);
                return (ENOMEM);
        }

        err = fwohci_init(sc, self);

        if (err != 0) {
                device_printf(self, "fwohci_init failed with err=%d\n", err);
                fwohci_pci_detach(self);
                return EIO;
        }

        /* probe and attach a child device(firewire) */
        bus_identify_children(self);
        bus_attach_children(self);

        return 0;
}

static int
fwohci_pci_detach(device_t self)
{
        fwohci_softc_t *sc = device_get_softc(self);
        int s;

        s = splfw();

        if (sc->bsr)
                fwohci_stop(sc, self);

        bus_generic_detach(self);

        /* disable interrupts that might have been switched on */
        if (sc->bst && sc->bsh)
                bus_space_write_4(sc->bst, sc->bsh,
                                  FWOHCI_INTMASKCLR, OHCI_INT_EN);

        if (sc->irq_res) {
                int err;
                if (sc->ih) {
                        err = bus_teardown_intr(self, sc->irq_res, sc->ih);
                        if (err)
                                device_printf(self,
                                         "Could not tear down irq, %d\n", err);
                        sc->ih = NULL;
                }
                bus_release_resource(self, SYS_RES_IRQ, 0, sc->irq_res);
                sc->irq_res = NULL;
        }

        if (sc->bsr) {
                bus_release_resource(self, SYS_RES_MEMORY, PCI_CBMEM, sc->bsr);
                sc->bsr = NULL;
                sc->bst = 0;
                sc->bsh = 0;
        }

        fwohci_detach(sc, self);
        mtx_destroy(FW_GMTX(&sc->fc));
        splx(s);

        return 0;
}

static int
fwohci_pci_suspend(device_t dev)
{
        fwohci_softc_t *sc = device_get_softc(dev);
        int err;

        device_printf(dev, "fwohci_pci_suspend\n");
        err = bus_generic_suspend(dev);
        if (err)
                return err;
        fwohci_stop(sc, dev);
        return 0;
}

static int
fwohci_pci_resume(device_t dev)
{
        fwohci_softc_t *sc = device_get_softc(dev);

        fwohci_pci_init(dev);
        fwohci_resume(sc, dev);
        return 0;
}

static int
fwohci_pci_shutdown(device_t dev)
{
        fwohci_softc_t *sc = device_get_softc(dev);

        bus_generic_shutdown(dev);
        fwohci_stop(sc, dev);
        return 0;
}

static device_t
fwohci_pci_add_child(device_t dev, u_int order, const char *name, int unit)
{
        struct fwohci_softc *sc;
        device_t child;
        int err = 0;

        sc = (struct fwohci_softc *)device_get_softc(dev);
        child = device_add_child(dev, name, unit);
        if (child == NULL)
                return (child);

        sc->fc.bdev = child;
        device_set_ivars(child, &sc->fc);

        err = device_probe_and_attach(child);
        if (err) {
                device_printf(dev, "probe_and_attach failed with err=%d\n",
                    err);
                fwohci_pci_detach(dev);
                device_delete_child(dev, child);
                return NULL;
        }

        /* XXX
         * Clear the bus reset event flag to start transactions even when
         * interrupt is disabled during the boot process.
         */
        if (cold) {
                int s;
                DELAY(250); /* 2 cycles */
                s = splfw();
                fwohci_poll(&sc->fc, 0, -1);
                splx(s);
        }

        return (child);
}

static device_method_t fwohci_methods[] = {
        /* Device interface */
        DEVMETHOD(device_probe,         fwohci_pci_probe),
        DEVMETHOD(device_attach,        fwohci_pci_attach),
        DEVMETHOD(device_detach,        fwohci_pci_detach),
        DEVMETHOD(device_suspend,       fwohci_pci_suspend),
        DEVMETHOD(device_resume,        fwohci_pci_resume),
        DEVMETHOD(device_shutdown,      fwohci_pci_shutdown),

        /* Bus interface */
        DEVMETHOD(bus_add_child,        fwohci_pci_add_child),

        DEVMETHOD_END
};

static driver_t fwohci_driver = {
        "fwohci",
        fwohci_methods,
        sizeof(fwohci_softc_t),
};

#ifdef FWOHCI_MODULE
MODULE_DEPEND(fwohci, firewire, 1, 1, 1);
#endif
DRIVER_MODULE(fwohci, pci, fwohci_driver, 0, 0);