summaryrefslogtreecommitdiffstats
path: root/sys/dev/mpt/mpt_pci.c
diff options
context:
space:
mode:
authormjacob <mjacob@FreeBSD.org>2002-08-11 23:34:20 +0000
committermjacob <mjacob@FreeBSD.org>2002-08-11 23:34:20 +0000
commitd8202a09a49f5fa629402a69d87030f38a6a6ccb (patch)
tree758fed3cc2fa476346895d84f9b66b89fb6fe36b /sys/dev/mpt/mpt_pci.c
parent7d35cb1395e04b65f75e3363a6ad67063bf66383 (diff)
downloadFreeBSD-src-d8202a09a49f5fa629402a69d87030f38a6a6ccb.zip
FreeBSD-src-d8202a09a49f5fa629402a69d87030f38a6a6ccb.tar.gz
Add support for the LSI-Logic Fusion/MP architecture.
This is an architecture that present a thing message passing interface to the OS. You can query as to how many ports and what kind are attached and enable them and so on. A less grand view is that this is just another way to package SCSI (SPI or FC) and FC-IP into a one-driver interface set. This driver support the following hardware: LSI FC909: Single channel, 1Gbps, Fibre Channel (FC-SCSI only) LSI FC929: Dual Channel, 1-2Gbps, Fibre Channel (FC-SCSI only) LSI 53c1020: Single Channel, Ultra4 (320M) (Untested) LSI 53c1030: Dual Channel, Ultra4 (320M) Currently it's in fair shape, but expect a lot of changes over the next few weeks as it stabilizes. Credits: The driver is mostly from some folks from Jeff Roberson's company- I've been slowly migrating it to broader support that I it came to me as. The hardware used in developing support came from: FC909: LSI-Logic, Advansys (now Connetix) FC929: LSI-Logic 53c1030: Antares Microsystems (they make a very fine board!) MFC after: 3 weeks
Diffstat (limited to 'sys/dev/mpt/mpt_pci.c')
-rw-r--r--sys/dev/mpt/mpt_pci.c638
1 files changed, 638 insertions, 0 deletions
diff --git a/sys/dev/mpt/mpt_pci.c b/sys/dev/mpt/mpt_pci.c
new file mode 100644
index 0000000..7af1bc9
--- /dev/null
+++ b/sys/dev/mpt/mpt_pci.c
@@ -0,0 +1,638 @@
+/* $FreeBSD$ */
+/*
+ * PCI specific probe and attach routines for LSI '909 FC adapters.
+ * FreeBSD Version.
+ *
+ * Copyright (c) 2000, 2001 by Greg Ansley
+ * Partially derived from Matt Jacob's ISP driver.
+ *
+ * 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 immediately at the beginning of the file, without modification,
+ * this list of conditions, and the following disclaimer.
+ * 2. 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 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.
+ */
+/*
+ * Additional Copyright (c) 2002 by Matthew Jacob under same license.
+ */
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/bus.h>
+#include <sys/conf.h>
+#include <sys/malloc.h>
+#include <sys/mbuf.h>
+#include <sys/module.h>
+#include <pci/pcireg.h>
+#include <pci/pcivar.h>
+
+#include <machine/bus_memio.h>
+#include <machine/bus_pio.h>
+#include <machine/bus.h>
+#include <machine/resource.h>
+#include <sys/rman.h>
+
+#include <dev/mpt/mpt.h>
+#include <dev/mpt/mpt_freebsd.h>
+
+#ifndef PCI_VENDOR_LSI
+#define PCI_VENDOR_LSI 0x1000
+#endif
+
+#ifndef PCI_PRODUCT_LSI_FC909
+#define PCI_PRODUCT_LSI_FC909 0x0620
+#endif
+
+#ifndef PCI_PRODUCT_LSI_FC929
+#define PCI_PRODUCT_LSI_FC929 0x0622
+#endif
+
+#ifndef PCI_PRODUCT_LSI_1030
+#define PCI_PRODUCT_LSI_1030 0x0030
+#endif
+
+
+
+#define MEM_MAP_REG 0x14
+#define MEM_MAP_SRAM 0x1C
+
+static int mpt_probe(device_t);
+static int mpt_attach(device_t);
+static void mpt_free_bus_resources(struct mpt_softc *mpt);
+static int mpt_detach(device_t);
+static int mpt_shutdown(device_t);
+static int mpt_dma_mem_alloc(struct mpt_softc *mpt);
+static void mpt_dma_mem_free(struct mpt_softc *mpt);
+static void mpt_read_config_regs(struct mpt_softc *mpt);
+
+static device_method_t mpt_methods[] = {
+ /* Device interface */
+ DEVMETHOD(device_probe, mpt_probe),
+ DEVMETHOD(device_attach, mpt_attach),
+ DEVMETHOD(device_detach, mpt_detach),
+ DEVMETHOD(device_shutdown, mpt_shutdown),
+ { 0, 0 }
+};
+
+static driver_t mpt_driver = {
+ "mpt", mpt_methods, sizeof (struct mpt_softc)
+};
+static devclass_t mpt_devclass;
+DRIVER_MODULE(mpt, pci, mpt_driver, mpt_devclass, 0, 0);
+MODULE_VERSION(mpt, 1);
+
+int
+mpt_intr(void *dummy)
+{
+ u_int32_t reply;
+ struct mpt_softc *mpt = (struct mpt_softc *)dummy;
+
+ reply = mpt_pop_reply_queue(mpt);
+ while (reply != MPT_REPLY_EMPTY) {
+ if (mpt->verbose > 1) {
+ if ((reply & MPT_CONTEXT_REPLY) != 0) {
+ /* Address reply; IOC has something to say */
+ mpt_print_reply(MPT_REPLY_PTOV(mpt, reply));
+ } else {
+ /* Context reply ; all went well */
+ device_printf(mpt->dev,
+ "context %u reply OK\n", reply);
+ }
+ }
+ mpt_done(mpt, reply);
+ reply = mpt_pop_reply_queue(mpt);
+ }
+ return 0;
+}
+
+static int
+mpt_probe(device_t dev)
+{
+ char *desc;
+
+ if (pci_get_vendor(dev) != PCI_VENDOR_LSI)
+ return (ENXIO);
+
+ switch ((pci_get_device(dev) & ~1)) {
+ case PCI_PRODUCT_LSI_FC909:
+ desc = "LSILogic FC909 FC Adapter";
+ break;
+ case PCI_PRODUCT_LSI_FC929:
+ desc = "LSILogic FC929 FC Adapter";
+ break;
+ case PCI_PRODUCT_LSI_1030:
+ desc = "LSILogic 1030 Ultra4 Adapter";
+ break;
+ default:
+ return (ENXIO);
+ }
+
+ device_set_desc(dev, desc);
+ return (0);
+}
+
+#ifdef RELENG_4
+static void
+mpt_set_options(struct mpt_softc *mpt)
+{
+ int bitmap;
+
+ bitmap = 0;
+ if (getenv_int("mpt_disable", &bitmap)) {
+ if (bitmap & (1 << mpt->unit)) {
+ mpt->disabled = 1;
+ }
+ }
+
+ bitmap = 0;
+ if (getenv_int("mpt_debug", &bitmap)) {
+ if (bitmap & (1 << mpt->unit)) {
+ mpt->verbose = 2;
+ }
+ }
+
+ cmd = pci_read_config(dev, PCIR_COMMAND, 2);
+}
+#else
+static void
+mpt_set_options(struct mpt_softc *mpt)
+{
+ int tval;
+
+ tval = 0;
+ if (resource_int_value(device_get_name(mpt->dev),
+ device_get_unit(mpt->dev), "disable", &tval) == 0 && tval != 0) {
+ mpt->disabled = 1;
+ }
+ tval = 0;
+ if (resource_int_value(device_get_name(mpt->dev),
+ device_get_unit(mpt->dev), "debug", &tval) == 0 && tval != 0) {
+ mpt->verbose += tval;
+ }
+}
+#endif
+
+
+static int
+mpt_attach(device_t dev)
+{
+ int iqd;
+ u_int32_t data, cmd;
+ struct mpt_softc *mpt;
+
+ /* Allocate the softc structure */
+ mpt = (struct mpt_softc*) device_get_softc(dev);
+ if (mpt == NULL) {
+ device_printf(dev, "cannot allocate softc\n");
+ return (ENOMEM);
+ }
+ bzero(mpt, sizeof (struct mpt_softc));
+ switch ((pci_get_device(dev) & ~1)) {
+ case PCI_PRODUCT_LSI_FC909:
+ case PCI_PRODUCT_LSI_FC929:
+ mpt->is_fc = 1;
+ break;
+ default:
+ break;
+ }
+ mpt->dev = dev;
+ mpt->unit = device_get_unit(dev);
+ mpt_set_options(mpt);
+ mpt->verbose += (bootverbose != 0)? 1 : 0;
+
+ /* Make sure memory access decoders are enabled */
+ cmd = pci_read_config(dev, PCIR_COMMAND, 2);
+ if ((cmd & PCIM_CMD_MEMEN) == 0) {
+ device_printf(dev, "Memory accesses disabled");
+ goto bad;
+ }
+
+ /*
+ * Make sure that SERR, PERR, WRITE INVALIDATE and BUSMASTER are set.
+ */
+ cmd |=
+ PCIM_CMD_SERRESPEN | PCIM_CMD_PERRESPEN |
+ PCIM_CMD_BUSMASTEREN | PCIM_CMD_MWRICEN;
+ pci_write_config(dev, PCIR_COMMAND, cmd, 2);
+
+ /*
+ * Make sure we've disabled the ROM.
+ */
+ data = pci_read_config(dev, PCIR_BIOS, 4);
+ data &= ~1;
+ pci_write_config(dev, PCIR_BIOS, data, 4);
+
+
+ /* Is this part a dual? */
+ if ((pci_get_device(dev) & ~1) == PCI_PRODUCT_LSI_FC929) {
+ /* Yes; is the previous device the counterpart? */
+ if (mpt->unit) {
+ mpt->mpt2 = (struct mpt_softc *)
+ devclass_get_softc(mpt_devclass, mpt->unit-1);
+
+ if ((mpt->mpt2->mpt2 == NULL)
+ && (pci_get_vendor(mpt->mpt2->dev) == PCI_VENDOR_LSI)
+ && ((pci_get_device(mpt->mpt2->dev) & ~1) == PCI_PRODUCT_LSI_FC929) ) {
+ /* Yes */
+ mpt->mpt2->mpt2 = mpt;
+ if (mpt->verbose) {
+ device_printf(dev, "Detected dual\n");
+ }
+ } else {
+ /* Nope */
+ mpt->mpt2 = NULL;
+ }
+ }
+ }
+
+ /* Set up the memory regions */
+ /* Allocate kernel virtual memory for the 9x9's Mem0 region */
+ mpt->pci_reg_id = MEM_MAP_REG;
+ mpt->pci_reg = bus_alloc_resource(dev, SYS_RES_MEMORY,
+ &mpt->pci_reg_id, 0, ~0, 0, RF_ACTIVE);
+ if (mpt->pci_reg == NULL) {
+ device_printf(dev, "unable to map any ports\n");
+ goto bad;
+ }
+ mpt->pci_st = rman_get_bustag(mpt->pci_reg);
+ mpt->pci_sh = rman_get_bushandle(mpt->pci_reg);
+ /* Get the Physical Address */
+ mpt->pci_pa = rman_get_start(mpt->pci_reg);
+
+ /* Get a handle to the interrupt */
+ iqd = 0;
+ mpt->pci_irq = bus_alloc_resource(dev, SYS_RES_IRQ, &iqd, 0, ~0,
+ 1, RF_ACTIVE | RF_SHAREABLE);
+ if (mpt->pci_irq == NULL) {
+ device_printf(dev, "could not allocate interrupt\n");
+ goto bad;
+ }
+
+ /* Register the interrupt handler */
+ if (bus_setup_intr(dev, mpt->pci_irq,
+ INTR_TYPE_CAM, (void (*)(void *))mpt_intr,
+ mpt, &mpt->ih)) {
+ device_printf(dev, "could not setup interrupt\n");
+ goto bad;
+ }
+
+ /* Disable interrupts at the part */
+ mpt_disable_ints(mpt);
+
+ /* Allocate dma memory */
+ if (mpt_dma_mem_alloc(mpt)) {
+ device_printf(dev, "Could not allocate DMA memory\n");
+ goto bad;
+ }
+
+ /* Initialize character device */
+ /* currently closed */
+ mpt->open = 0;
+
+ /* Save the PCI config register values */
+ /* Hard resets are known to screw up the BAR for diagnostic
+ memory accesses (Mem1). */
+ /* Using Mem1 is known to make the chip stop responding to
+ configuration space transfers, so we need to save it now */
+ mpt_read_config_regs(mpt);
+
+ /* Initialize the hardware */
+ if (mpt->disabled == 0) {
+ if (mpt_init(mpt, MPT_DB_INIT_HOST) != 0)
+ goto bad;
+
+ /* Attach to CAM */
+ mpt_cam_attach(mpt);
+ }
+
+ /* Done */
+ return (0);
+
+bad:
+ mpt_dma_mem_free(mpt);
+ mpt_free_bus_resources(mpt);
+
+ /*
+ * but return zero to preserve unit numbering
+ */
+ return (0);
+}
+
+/******************************************************************************
+ * Free bus resources
+ */
+static void
+mpt_free_bus_resources(struct mpt_softc *mpt)
+{
+ if (mpt->ih) {
+ bus_teardown_intr(mpt->dev, mpt->pci_irq, mpt->ih);
+ mpt->ih = 0;
+ }
+
+ if (mpt->pci_irq) {
+ bus_release_resource(mpt->dev, SYS_RES_IRQ, 0, mpt->pci_irq);
+ mpt->pci_irq = 0;
+ }
+
+ if (mpt->pci_reg) {
+ bus_release_resource(mpt->dev, SYS_RES_MEMORY, mpt->pci_reg_id,
+ mpt->pci_reg);
+ mpt->pci_reg = 0;
+ }
+ if (mpt->pci_mem) {
+ bus_release_resource(mpt->dev, SYS_RES_MEMORY, mpt->pci_mem_id,
+ mpt->pci_mem);
+ mpt->pci_mem = 0;
+ }
+
+}
+
+
+/******************************************************************************
+ * Disconnect ourselves from the system.
+ */
+static int
+mpt_detach(device_t dev)
+{
+ struct mpt_softc *mpt;
+ mpt = (struct mpt_softc*) device_get_softc(dev);
+
+ device_printf(mpt->dev,"mpt_detach!\n");
+
+ if (mpt) {
+ mpt_disable_ints(mpt);
+ mpt_cam_detach(mpt);
+ mpt_reset(mpt);
+ mpt_dma_mem_free(mpt);
+ mpt_free_bus_resources(mpt);
+ }
+ return(0);
+}
+
+
+/******************************************************************************
+ * Disable the hardware
+ */
+static int
+mpt_shutdown(device_t dev)
+{
+ struct mpt_softc *mpt;
+ mpt = (struct mpt_softc*) device_get_softc(dev);
+
+ if (mpt) {
+ mpt_reset(mpt);
+ }
+ return(0);
+}
+
+
+struct imush {
+ struct mpt_softc *mpt;
+ int error;
+ u_int32_t phys;
+};
+
+static void
+mpt_map_rquest(void *arg, bus_dma_segment_t *segs, int nseg, int error)
+{
+ struct imush *imushp = (struct imush *) arg;
+ imushp->error = error;
+ imushp->phys = segs->ds_addr;
+}
+
+
+static int
+mpt_dma_mem_alloc(struct mpt_softc *mpt)
+{
+ int i, error;
+ u_char *vptr;
+ u_int32_t pptr, end;
+ struct imush im;
+ device_t dev = mpt->dev;
+
+ /* Check if we alreay have allocated the reply memory */
+ if (mpt->reply_phys != NULL)
+ return 0;
+
+ /*
+ * Create a dma tag for this device
+ *
+ * Align at page boundaries, limit to 32-bit addressing
+ * (The chip supports 64-bit addressing, but this driver doesn't)
+ */
+ if (bus_dma_tag_create(NULL, PAGE_SIZE, 0, BUS_SPACE_MAXADDR_32BIT,
+ BUS_SPACE_MAXADDR, NULL, NULL, BUS_SPACE_MAXSIZE_32BIT,
+ BUS_SPACE_MAXSIZE_32BIT, BUS_SPACE_UNRESTRICTED, 0,
+ &mpt->parent_dmat) != 0) {
+ device_printf(dev, "cannot create parent dma tag\n");
+ return (1);
+ }
+
+ /* Create a child tag for reply buffers */
+ if (bus_dma_tag_create(mpt->parent_dmat, PAGE_SIZE,
+ 0, BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
+ NULL, NULL, PAGE_SIZE, 1, BUS_SPACE_MAXSIZE_32BIT, 0,
+ &mpt->reply_dmat) != 0) {
+ device_printf(dev, "cannot create a dma tag for replies\n");
+ return (1);
+ }
+
+ /* Allocate some DMA accessable memory for replies */
+ if (bus_dmamem_alloc(mpt->reply_dmat, (void **)&mpt->reply,
+ BUS_DMA_NOWAIT, &mpt->reply_dmap) != 0) {
+ device_printf(dev, "cannot allocate %d bytes of reply memory\n",
+ PAGE_SIZE);
+ return (1);
+ }
+
+ im.mpt = mpt;
+ im.error = 0;
+
+ /* Load and lock it into "bus space" */
+ bus_dmamap_load(mpt->reply_dmat, mpt->reply_dmap, mpt->reply,
+ PAGE_SIZE, mpt_map_rquest, &im, 0);
+
+ if (im.error) {
+ device_printf(dev,
+ "error %d loading dma map for DMA reply queue\n", im.error);
+ return (1);
+ }
+ mpt->reply_phys = im.phys;
+
+ /* Create a child tag for data buffers */
+ if (bus_dma_tag_create(mpt->parent_dmat, PAGE_SIZE,
+ 0, BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
+ NULL, NULL, MAXBSIZE, MPT_SGL_MAX, BUS_SPACE_MAXSIZE_32BIT, 0,
+ &mpt->buffer_dmat) != 0) {
+ device_printf(dev,
+ "cannot create a dma tag for data buffers\n");
+ return (1);
+ }
+
+ /* Create a child tag for request buffers */
+ if (bus_dma_tag_create(mpt->parent_dmat, PAGE_SIZE,
+ 0, BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
+ NULL, NULL, MPT_REQ_MEM_SIZE, 1, BUS_SPACE_MAXSIZE_32BIT, 0,
+ &mpt->request_dmat) != 0) {
+ device_printf(dev, "cannot create a dma tag for requests\n");
+ return (1);
+ }
+
+ /* Allocate some DMA accessable memory for requests */
+ if (bus_dmamem_alloc(mpt->request_dmat, (void **)&mpt->request,
+ BUS_DMA_NOWAIT, &mpt->request_dmap) != 0) {
+ device_printf(dev,
+ "cannot allocate %d bytes of request memory\n",
+ MPT_REQ_MEM_SIZE);
+ return (1);
+ }
+
+ im.mpt = mpt;
+ im.error = 0;
+
+ /* Load and lock it into "bus space" */
+ bus_dmamap_load(mpt->request_dmat, mpt->request_dmap, mpt->request,
+ MPT_REQ_MEM_SIZE, mpt_map_rquest, &im, 0);
+
+ if (im.error) {
+ device_printf(dev,
+ "error %d loading dma map for DMA request queue\n",
+ im.error);
+ return (1);
+ }
+ mpt->request_phys = im.phys;
+
+ i = 0;
+ pptr = mpt->request_phys;
+ vptr = mpt->request;
+ end = pptr + MPT_REQ_MEM_SIZE;
+ while(pptr < end) {
+ request_t *req = &mpt->requests[i];
+ req->index = i++;
+
+ /* Store location of Request Data */
+ req->req_pbuf = pptr;
+ req->req_vbuf = vptr;
+
+ pptr += MPT_REQUEST_AREA;
+ vptr += MPT_REQUEST_AREA;
+
+ req->sense_pbuf = (pptr - MPT_SENSE_SIZE);
+ req->sense_vbuf = (vptr - MPT_SENSE_SIZE);
+
+ error = bus_dmamap_create(mpt->buffer_dmat, 0, &req->dmap);
+ if (error) {
+ device_printf(dev,
+ "error %d creating per-cmd DMA maps\n", error);
+ return (1);
+ }
+ }
+ return (0);
+}
+
+
+
+/* Deallocate memory that was allocated by mpt_dma_mem_alloc
+ */
+static void
+mpt_dma_mem_free(struct mpt_softc *mpt)
+{
+ int i;
+
+ /* Make sure we aren't double destroying */
+ if (mpt->reply_dmat == 0) {
+ if (mpt->verbose)
+ device_printf(mpt->dev,"Already released dma memory\n");
+ return;
+ }
+
+ for (i = 0; i < MPT_MAX_REQUESTS; i++) {
+ bus_dmamap_destroy(mpt->buffer_dmat, mpt->requests[i].dmap);
+ }
+ bus_dmamap_unload(mpt->request_dmat, mpt->request_dmap);
+ bus_dmamem_free(mpt->request_dmat, mpt->request, mpt->request_dmap);
+ bus_dma_tag_destroy(mpt->request_dmat);
+ bus_dma_tag_destroy(mpt->buffer_dmat);
+ bus_dmamap_unload(mpt->reply_dmat, mpt->reply_dmap);
+ bus_dmamem_free(mpt->reply_dmat, mpt->reply, mpt->reply_dmap);
+ bus_dma_tag_destroy(mpt->reply_dmat);
+ bus_dma_tag_destroy(mpt->parent_dmat);
+ mpt->reply_dmat = 0;
+
+}
+
+
+
+/* Reads modifiable (via PCI transactions) config registers */
+static void
+mpt_read_config_regs(struct mpt_softc *mpt)
+{
+ mpt->pci_cfg.Command = pci_read_config(mpt->dev, PCIR_COMMAND, 2);
+ mpt->pci_cfg.LatencyTimer_LineSize =
+ pci_read_config(mpt->dev, PCIR_CACHELNSZ, 2);
+ mpt->pci_cfg.IO_BAR = pci_read_config(mpt->dev, PCIR_MAPS, 4);
+ mpt->pci_cfg.Mem0_BAR[0] = pci_read_config(mpt->dev, PCIR_MAPS+0x4, 4);
+ mpt->pci_cfg.Mem0_BAR[1] = pci_read_config(mpt->dev, PCIR_MAPS+0x8, 4);
+ mpt->pci_cfg.Mem1_BAR[0] = pci_read_config(mpt->dev, PCIR_MAPS+0xC, 4);
+ mpt->pci_cfg.Mem1_BAR[1] = pci_read_config(mpt->dev, PCIR_MAPS+0x10, 4);
+ mpt->pci_cfg.ROM_BAR = pci_read_config(mpt->dev, PCIR_BIOS, 4);
+ mpt->pci_cfg.IntLine = pci_read_config(mpt->dev, PCIR_INTLINE, 1);
+ mpt->pci_cfg.PMCSR = pci_read_config(mpt->dev, 0x44, 4);
+}
+
+/* Sets modifiable config registers */
+void
+mpt_set_config_regs(struct mpt_softc *mpt)
+{
+ u_int32_t val;
+
+#define MPT_CHECK(reg, offset, size) \
+ val = pci_read_config(mpt->dev, offset, size); \
+ if (mpt->pci_cfg.reg != val) { \
+ device_printf(mpt->dev, \
+ "Restoring " #reg " to 0x%X from 0x%X\n", \
+ mpt->pci_cfg.reg, val); \
+ }
+
+ if (mpt->verbose) {
+ MPT_CHECK(Command, PCIR_COMMAND, 2);
+ MPT_CHECK(LatencyTimer_LineSize, PCIR_CACHELNSZ, 2);
+ MPT_CHECK(IO_BAR, PCIR_MAPS, 4);
+ MPT_CHECK(Mem0_BAR[0], PCIR_MAPS+0x4, 4);
+ MPT_CHECK(Mem0_BAR[1], PCIR_MAPS+0x8, 4);
+ MPT_CHECK(Mem1_BAR[0], PCIR_MAPS+0xC, 4);
+ MPT_CHECK(Mem1_BAR[1], PCIR_MAPS+0x10, 4);
+ MPT_CHECK(ROM_BAR, PCIR_BIOS, 4);
+ MPT_CHECK(IntLine, PCIR_INTLINE, 1);
+ MPT_CHECK(PMCSR, 0x44, 4);
+ }
+#undef MPT_CHECK
+
+ pci_write_config(mpt->dev, PCIR_COMMAND, mpt->pci_cfg.Command, 2);
+ pci_write_config(mpt->dev, PCIR_CACHELNSZ,
+ mpt->pci_cfg.LatencyTimer_LineSize, 2);
+ pci_write_config(mpt->dev, PCIR_MAPS, mpt->pci_cfg.IO_BAR, 4);
+ pci_write_config(mpt->dev, PCIR_MAPS+0x4, mpt->pci_cfg.Mem0_BAR[0], 4);
+ pci_write_config(mpt->dev, PCIR_MAPS+0x8, mpt->pci_cfg.Mem0_BAR[1], 4);
+ pci_write_config(mpt->dev, PCIR_MAPS+0xC, mpt->pci_cfg.Mem1_BAR[0], 4);
+ pci_write_config(mpt->dev, PCIR_MAPS+0x10, mpt->pci_cfg.Mem1_BAR[1], 4);
+ pci_write_config(mpt->dev, PCIR_BIOS, mpt->pci_cfg.ROM_BAR, 4);
+ pci_write_config(mpt->dev, PCIR_INTLINE, mpt->pci_cfg.IntLine, 1);
+ pci_write_config(mpt->dev, 0x44, mpt->pci_cfg.PMCSR, 4);
+}
OpenPOWER on IntegriCloud