sys/dev/disk/mpt/mpt_pci.c

   1 /* $FreeBSD: src/sys/dev/mpt/mpt_pci.c,v 1.3.2.3 2002/09/24 21:37:25 mjacob Exp $ */
   2 /* $DragonFly: src/sys/dev/disk/mpt/mpt_pci.c,v 1.9 2006/10/25 20:55:53 dillon Exp $ */
   3 /*
   4  * PCI specific probe and attach routines for LSI '909 FC  adapters.
   5  * FreeBSD Version.
   6  *
   7  * Copyright (c)  2000, 2001 by Greg Ansley
   8  * Partially derived from Matt Jacob's ISP driver.
   9  *
  10  * Redistribution and use in source and binary forms, with or without
  11  * modification, are permitted provided that the following conditions
  12  * are met:
  13  * 1. Redistributions of source code must retain the above copyright
  14  *    notice immediately at the beginning of the file, without modification,
  15  *    this list of conditions, and the following disclaimer.
  16  * 2. The name of the author may not be used to endorse or promote products
  17  *    derived from this software without specific prior written permission.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  22  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
  23  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  29  * SUCH DAMAGE.
  30  */
  31 /*
  32  * Additional Copyright (c) 2002 by Matthew Jacob under same license.
  33  */
  34
  35 #include <sys/param.h>
  36 #include <sys/systm.h>
  37 #include <sys/kernel.h>
  38 #include <sys/module.h>
  39 #include <sys/bus.h>
  40 #include <sys/rman.h>
  41 #include <sys/malloc.h>
  42
  43 #include <bus/pci/pcidevs.h>
  44 #include <bus/pci/pcireg.h>
  45 #include <bus/pci/pcivar.h>
  46
  47 #include "mpt_freebsd.h"
  48
  49 #ifndef PCIM_CMD_SERRESPEN
  50 #define PCIM_CMD_SERRESPEN      0x0100
  51 #endif
  52
  53
  54
  55 #define MEM_MAP_REG     0x14
  56 #define MEM_MAP_SRAM    0x1C
  57
  58 static int mpt_probe(device_t);
  59 static int mpt_attach(device_t);
  60 static void mpt_free_bus_resources(mpt_softc_t *mpt);
  61 static int mpt_detach(device_t);
  62 static int mpt_shutdown(device_t);
  63 static int mpt_dma_mem_alloc(mpt_softc_t *mpt);
  64 static void mpt_dma_mem_free(mpt_softc_t *mpt);
  65 static void mpt_read_config_regs(mpt_softc_t *mpt);
  66 static void mpt_pci_intr(void *);
  67
  68 static device_method_t mpt_methods[] = {
  69         /* Device interface */
  70         DEVMETHOD(device_probe,         mpt_probe),
  71         DEVMETHOD(device_attach,        mpt_attach),
  72         DEVMETHOD(device_detach,        mpt_detach),
  73         DEVMETHOD(device_shutdown,      mpt_shutdown),
  74         { 0, 0 }
  75 };
  76
  77 static driver_t mpt_driver = {
  78         "mpt", mpt_methods, sizeof (mpt_softc_t)
  79 };
  80 static devclass_t mpt_devclass;
  81 DRIVER_MODULE(mpt, pci, mpt_driver, mpt_devclass, 0, 0);
  82 MODULE_VERSION(mpt, 1);
  83
  84 int
  85 mpt_intr(void *dummy)
  86 {
  87         int nrepl = 0;
  88         u_int32_t reply;
  89         mpt_softc_t *mpt = (mpt_softc_t *)dummy;
  90
  91         if ((mpt_read(mpt, MPT_OFFSET_INTR_STATUS) & MPT_INTR_REPLY_READY) == 0)
  92                 return (0);
  93         reply = mpt_pop_reply_queue(mpt);
  94         while (reply != MPT_REPLY_EMPTY) {
  95                 nrepl++;
  96                 if (mpt->verbose > 1) {
  97                         if ((reply & MPT_CONTEXT_REPLY) != 0)  {
  98                                 /* Address reply; IOC has something to say */
  99                                 mpt_print_reply(MPT_REPLY_PTOV(mpt, reply));
 100                         } else {
 101                                 /* Context reply ; all went well */
 102                                 device_printf(mpt->dev,
 103                                     "context %u reply OK\n", reply);
 104                         }
 105                 }
 106                 mpt_done(mpt, reply);
 107                 reply = mpt_pop_reply_queue(mpt);
 108         }
 109         return (nrepl != 0);
 110 }
 111
 112 static int
 113 mpt_probe(device_t dev)
 114 {
 115         char *desc;
 116
 117         if (pci_get_vendor(dev) != PCI_VENDOR_SYMBIOS)
 118                 return (ENXIO);
 119
 120         switch ((pci_get_device(dev) & ~1)) {
 121         case PCI_PRODUCT_SYMBIOS_FC909:
 122                 desc = "LSILogic FC909 FC Adapter";
 123                 break;
 124         case PCI_PRODUCT_SYMBIOS_FC909A:
 125                 desc = "LSILogic FC909A FC Adapter";
 126                 break;
 127         case PCI_PRODUCT_SYMBIOS_FC919:
 128                 desc = "LSILogic FC919 FC Adapter";
 129                 break;
 130         case PCI_PRODUCT_SYMBIOS_FC929:
 131                 desc = "LSILogic FC929 FC Adapter";
 132                 break;
 133         case PCI_PRODUCT_SYMBIOS_1030:
 134                 desc = "LSILogic 1030 Ultra4 Adapter";
 135                 break;
 136         default:
 137                 return (ENXIO);
 138         }
 139
 140         device_set_desc(dev, desc);
 141         return (0);
 142 }
 143
 144 #ifdef  RELENG_4
 145 static void
 146 mpt_set_options(mpt_softc_t *mpt)
 147 {
 148         int bitmap;
 149
 150         bitmap = 0;
 151         if (kgetenv_int("mpt_disable", &bitmap)) {
 152                 if (bitmap & (1 << mpt->unit)) {
 153                         mpt->disabled = 1;
 154                 }
 155         }
 156
 157         bitmap = 0;
 158         if (kgetenv_int("mpt_debug", &bitmap)) {
 159                 if (bitmap & (1 << mpt->unit)) {
 160                         mpt->verbose = 2;
 161                 }
 162         }
 163
 164 }
 165 #else
 166 static void
 167 mpt_set_options(mpt_softc_t *mpt)
 168 {
 169         int tval;
 170
 171         tval = 0;
 172         if (resource_int_value(device_get_name(mpt->dev),
 173             device_get_unit(mpt->dev), "disable", &tval) == 0 && tval != 0) {
 174                 mpt->disabled = 1;
 175         }
 176         tval = 0;
 177         if (resource_int_value(device_get_name(mpt->dev),
 178             device_get_unit(mpt->dev), "debug", &tval) == 0 && tval != 0) {
 179                 mpt->verbose += tval;
 180         }
 181 }
 182 #endif
 183
 184
 185 static void
 186 mpt_link_peer(mpt_softc_t *mpt)
 187 {
 188         mpt_softc_t *mpt2;
 189
 190         if (mpt->unit == 0) {
 191                 return;
 192         }
 193
 194         /*
 195          * XXX: depends on probe order
 196          */
 197         mpt2 = (mpt_softc_t *) devclass_get_softc(mpt_devclass, mpt->unit-1);
 198
 199         if (mpt2 == NULL) {
 200                 return;
 201         }
 202         if (pci_get_vendor(mpt2->dev) != pci_get_vendor(mpt->dev)) {
 203                 return;
 204         }
 205         if (pci_get_device(mpt2->dev) != pci_get_device(mpt->dev)) {
 206                 return;
 207         }
 208         mpt->mpt2 = mpt2;
 209         mpt2->mpt2 = mpt;
 210         if (mpt->verbose) {
 211                 device_printf(mpt->dev, "linking with peer (mpt%d)\n",
 212                     device_get_unit(mpt2->dev));
 213         }
 214 }
 215
 216
 217 static int
 218 mpt_attach(device_t dev)
 219 {
 220         int iqd;
 221         u_int32_t data, cmd;
 222         mpt_softc_t *mpt;
 223
 224         /* Allocate the softc structure */
 225         mpt  = (mpt_softc_t*) device_get_softc(dev);
 226         if (mpt == NULL) {
 227                 device_printf(dev, "cannot allocate softc\n");
 228                 return (ENOMEM);
 229         }
 230         bzero(mpt, sizeof (mpt_softc_t));
 231         switch ((pci_get_device(dev) & ~1)) {
 232         case PCI_PRODUCT_SYMBIOS_FC909:
 233         case PCI_PRODUCT_SYMBIOS_FC909A:
 234         case PCI_PRODUCT_SYMBIOS_FC919:
 235         case PCI_PRODUCT_SYMBIOS_FC929:
 236                 mpt->is_fc = 1;
 237                 break;
 238         default:
 239                 break;
 240         }
 241         mpt->dev = dev;
 242         mpt->unit = device_get_unit(dev);
 243         mpt_set_options(mpt);
 244         mpt->verbose += (bootverbose != 0)? 1 : 0;
 245
 246         /* Make sure memory access decoders are enabled */
 247         cmd = pci_read_config(dev, PCIR_COMMAND, 2);
 248         if ((cmd & PCIM_CMD_MEMEN) == 0) {
 249                 device_printf(dev, "Memory accesses disabled");
 250                 goto bad;
 251         }
 252
 253         /*
 254          * Make sure that SERR, PERR, WRITE INVALIDATE and BUSMASTER are set.
 255          */
 256         cmd |=
 257             PCIM_CMD_SERRESPEN | PCIM_CMD_PERRESPEN |
 258             PCIM_CMD_BUSMASTEREN | PCIM_CMD_MWRICEN;
 259         pci_write_config(dev, PCIR_COMMAND, cmd, 2);
 260
 261         /*
 262          * Make sure we've disabled the ROM.
 263          */
 264         data = pci_read_config(dev, PCIR_BIOS, 4);
 265         data &= ~1;
 266         pci_write_config(dev, PCIR_BIOS, data, 4);
 267
 268
 269         /*
 270          * Is this part a dual?
 271          * If so, link with our partner (around yet)
 272          */
 273         if ((pci_get_device(dev) & ~1) == PCI_PRODUCT_SYMBIOS_FC929 ||
 274             (pci_get_device(dev) & ~1) == PCI_PRODUCT_SYMBIOS_1030) {
 275                 mpt_link_peer(mpt);
 276         }
 277
 278         /* Set up the memory regions */
 279         /* Allocate kernel virtual memory for the 9x9's Mem0 region */
 280         mpt->pci_reg_id = MEM_MAP_REG;
 281         mpt->pci_reg = bus_alloc_resource(dev, SYS_RES_MEMORY,
 282                         &mpt->pci_reg_id, 0, ~0, 0, RF_ACTIVE);
 283         if (mpt->pci_reg == NULL) {
 284                 device_printf(dev, "unable to map any ports\n");
 285                 goto bad;
 286         }
 287         mpt->pci_st = rman_get_bustag(mpt->pci_reg);
 288         mpt->pci_sh = rman_get_bushandle(mpt->pci_reg);
 289         /*   Get the Physical Address */
 290         mpt->pci_pa = rman_get_start(mpt->pci_reg);
 291
 292         /* Get a handle to the interrupt */
 293         iqd = 0;
 294         mpt->pci_irq = bus_alloc_resource(dev, SYS_RES_IRQ, &iqd, 0, ~0,
 295             1, RF_ACTIVE | RF_SHAREABLE);
 296         if (mpt->pci_irq == NULL) {
 297                 device_printf(dev, "could not allocate interrupt\n");
 298                 goto bad;
 299         }
 300
 301         /* Register the interrupt handler */
 302         if (bus_setup_intr(dev, mpt->pci_irq, MPT_IFLAGS, mpt_pci_intr,
 303                            mpt, &mpt->ih, NULL)) {
 304                 device_printf(dev, "could not setup interrupt\n");
 305                 goto bad;
 306         }
 307
 308         MPT_LOCK_SETUP(mpt);
 309
 310         /* Disable interrupts at the part */
 311         mpt_disable_ints(mpt);
 312
 313         /* Allocate dma memory */
 314         if (mpt_dma_mem_alloc(mpt)) {
 315                 device_printf(dev, "Could not allocate DMA memory\n");
 316                 goto bad;
 317         }
 318
 319         /*
 320          * Save the PCI config register values
 321          *
 322          * Hard resets are known to screw up the BAR for diagnostic
 323          * memory accesses (Mem1).
 324          *
 325          * Using Mem1 is known to make the chip stop responding to
 326          * configuration space transfers, so we need to save it now
 327          */
 328
 329         mpt_read_config_regs(mpt);
 330
 331         /* Initialize the hardware */
 332         if (mpt->disabled == 0) {
 333                 MPT_LOCK(mpt);
 334                 if (mpt_init(mpt, MPT_DB_INIT_HOST) != 0) {
 335                         MPT_UNLOCK(mpt);
 336                         goto bad;
 337                 }
 338
 339                 /*
 340                  *  Attach to CAM
 341                  */
 342                 mpt_cam_attach(mpt);
 343                 MPT_UNLOCK(mpt);
 344         }
 345
 346         return (0);
 347
 348 bad:
 349         mpt_dma_mem_free(mpt);
 350         mpt_free_bus_resources(mpt);
 351
 352         /*
 353          * but return zero to preserve unit numbering
 354          */
 355         return (0);
 356 }
 357
 358 /*
 359  * Free bus resources
 360  */
 361 static void
 362 mpt_free_bus_resources(mpt_softc_t *mpt)
 363 {
 364         if (mpt->ih) {
 365                 bus_teardown_intr(mpt->dev, mpt->pci_irq, mpt->ih);
 366                 mpt->ih = 0;
 367         }
 368
 369         if (mpt->pci_irq) {
 370                 bus_release_resource(mpt->dev, SYS_RES_IRQ, 0, mpt->pci_irq);
 371                 mpt->pci_irq = 0;
 372         }
 373
 374         if (mpt->pci_reg) {
 375                 bus_release_resource(mpt->dev, SYS_RES_MEMORY, mpt->pci_reg_id,
 376                         mpt->pci_reg);
 377                 mpt->pci_reg = 0;
 378         }
 379         MPT_LOCK_DESTROY(mpt);
 380 }
 381
 382
 383 /*
 384  * Disconnect ourselves from the system.
 385  */
 386 static int
 387 mpt_detach(device_t dev)
 388 {
 389         mpt_softc_t *mpt;
 390         mpt  = (mpt_softc_t*) device_get_softc(dev);
 391
 392         device_printf(mpt->dev,"mpt_detach!\n");
 393
 394         if (mpt) {
 395                 mpt_disable_ints(mpt);
 396                 mpt_cam_detach(mpt);
 397                 mpt_reset(mpt);
 398                 mpt_dma_mem_free(mpt);
 399                 mpt_free_bus_resources(mpt);
 400         }
 401         return(0);
 402 }
 403
 404
 405 /*
 406  * Disable the hardware
 407  */
 408 static int
 409 mpt_shutdown(device_t dev)
 410 {
 411         mpt_softc_t *mpt;
 412         mpt  = (mpt_softc_t*) device_get_softc(dev);
 413
 414         if (mpt) {
 415                 mpt_reset(mpt);
 416         }
 417         return(0);
 418 }
 419
 420
 421 struct imush {
 422         mpt_softc_t *mpt;
 423         int error;
 424         u_int32_t phys;
 425 };
 426
 427 static void
 428 mpt_map_rquest(void *arg, bus_dma_segment_t *segs, int nseg, int error)
 429 {
 430         struct imush *imushp = (struct imush *) arg;
 431         imushp->error = error;
 432         imushp->phys = segs->ds_addr;
 433 }
 434
 435
 436 static int
 437 mpt_dma_mem_alloc(mpt_softc_t *mpt)
 438 {
 439         int i, error;
 440         u_char *vptr;
 441         u_int32_t pptr, end;
 442         size_t len;
 443         struct imush im;
 444         device_t dev = mpt->dev;
 445
 446         /* Check if we alreay have allocated the reply memory */
 447         if (mpt->reply_phys != NULL) {
 448                 return 0;
 449         }
 450
 451         len = sizeof (request_t *) * MPT_REQ_MEM_SIZE(mpt);
 452 #ifdef  RELENG_4
 453         mpt->request_pool = (request_t *) kmalloc(len, M_DEVBUF, M_WAITOK);
 454         if (mpt->request_pool == NULL) {
 455                 device_printf(dev, "cannot allocate request pool\n");
 456                 return (1);
 457         }
 458         bzero(mpt->request_pool, len);
 459 #else
 460         mpt->request_pool = (request_t *)
 461             kmalloc(len, M_DEVBUF, M_WAITOK | M_ZERO);
 462         if (mpt->request_pool == NULL) {
 463                 device_printf(dev, "cannot allocate request pool\n");
 464                 return (1);
 465         }
 466 #endif
 467
 468         /*
 469          * Create a dma tag for this device
 470          *
 471          * Align at page boundaries, limit to 32-bit addressing
 472          * (The chip supports 64-bit addressing, but this driver doesn't)
 473          */
 474         if (bus_dma_tag_create(NULL, PAGE_SIZE, 0, BUS_SPACE_MAXADDR_32BIT,
 475             BUS_SPACE_MAXADDR, NULL, NULL, BUS_SPACE_MAXSIZE_32BIT,
 476             BUS_SPACE_MAXSIZE_32BIT, BUS_SPACE_UNRESTRICTED, 0,
 477             &mpt->parent_dmat) != 0) {
 478                 device_printf(dev, "cannot create parent dma tag\n");
 479                 return (1);
 480         }
 481
 482         /* Create a child tag for reply buffers */
 483         if (bus_dma_tag_create(mpt->parent_dmat, PAGE_SIZE,
 484             0, BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
 485             NULL, NULL, PAGE_SIZE, 1, BUS_SPACE_MAXSIZE_32BIT, 0,
 486             &mpt->reply_dmat) != 0) {
 487                 device_printf(dev, "cannot create a dma tag for replies\n");
 488                 return (1);
 489         }
 490
 491         /* Allocate some DMA accessable memory for replies */
 492         if (bus_dmamem_alloc(mpt->reply_dmat, (void **)&mpt->reply,
 493             BUS_DMA_NOWAIT, &mpt->reply_dmap) != 0) {
 494                 device_printf(dev, "cannot allocate %d bytes of reply memory\n",
 495                      PAGE_SIZE);
 496                 return (1);
 497         }
 498
 499         im.mpt = mpt;
 500         im.error = 0;
 501
 502         /* Load and lock it into "bus space" */
 503         bus_dmamap_load(mpt->reply_dmat, mpt->reply_dmap, mpt->reply,
 504             PAGE_SIZE, mpt_map_rquest, &im, 0);
 505
 506         if (im.error) {
 507                 device_printf(dev,
 508                     "error %d loading dma map for DMA reply queue\n", im.error);
 509                 return (1);
 510         }
 511         mpt->reply_phys = im.phys;
 512
 513         /* Create a child tag for data buffers */
 514         if (bus_dma_tag_create(mpt->parent_dmat, PAGE_SIZE,
 515             0, BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
 516             NULL, NULL, MAXBSIZE, MPT_SGL_MAX, BUS_SPACE_MAXSIZE_32BIT, 0,
 517             &mpt->buffer_dmat) != 0) {
 518                 device_printf(dev,
 519                     "cannot create a dma tag for data buffers\n");
 520                 return (1);
 521         }
 522
 523         /* Create a child tag for request buffers */
 524         if (bus_dma_tag_create(mpt->parent_dmat, PAGE_SIZE,
 525             0, BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
 526             NULL, NULL, MPT_REQ_MEM_SIZE(mpt), 1, BUS_SPACE_MAXSIZE_32BIT, 0,
 527             &mpt->request_dmat) != 0) {
 528                 device_printf(dev, "cannot create a dma tag for requests\n");
 529                 return (1);
 530         }
 531
 532         /* Allocate some DMA accessable memory for requests */
 533         if (bus_dmamem_alloc(mpt->request_dmat, (void **)&mpt->request,
 534             BUS_DMA_NOWAIT, &mpt->request_dmap) != 0) {
 535                 device_printf(dev,
 536                     "cannot allocate %d bytes of request memory\n",
 537                     MPT_REQ_MEM_SIZE(mpt));
 538                 return (1);
 539         }
 540
 541         im.mpt = mpt;
 542         im.error = 0;
 543
 544         /* Load and lock it into "bus space" */
 545         bus_dmamap_load(mpt->request_dmat, mpt->request_dmap, mpt->request,
 546             MPT_REQ_MEM_SIZE(mpt), mpt_map_rquest, &im, 0);
 547
 548         if (im.error) {
 549                 device_printf(dev,
 550                     "error %d loading dma map for DMA request queue\n",
 551                     im.error);
 552                 return (1);
 553         }
 554         mpt->request_phys = im.phys;
 555
 556         i = 0;
 557         pptr =  mpt->request_phys;
 558         vptr =  mpt->request;
 559         end = pptr + MPT_REQ_MEM_SIZE(mpt);
 560         while(pptr < end) {
 561                 request_t *req = &mpt->request_pool[i];
 562                 req->index = i++;
 563
 564                 /* Store location of Request Data */
 565                 req->req_pbuf = pptr;
 566                 req->req_vbuf = vptr;
 567
 568                 pptr += MPT_REQUEST_AREA;
 569                 vptr += MPT_REQUEST_AREA;
 570
 571                 req->sense_pbuf = (pptr - MPT_SENSE_SIZE);
 572                 req->sense_vbuf = (vptr - MPT_SENSE_SIZE);
 573
 574                 error = bus_dmamap_create(mpt->buffer_dmat, 0, &req->dmap);
 575                 if (error) {
 576                         device_printf(dev,
 577                              "error %d creating per-cmd DMA maps\n", error);
 578                         return (1);
 579                 }
 580         }
 581         return (0);
 582 }
 583
 584
 585
 586 /* Deallocate memory that was allocated by mpt_dma_mem_alloc
 587  */
 588 static void
 589 mpt_dma_mem_free(mpt_softc_t *mpt)
 590 {
 591         int i;
 592
 593         /* Make sure we aren't double destroying */
 594         if (mpt->reply_dmat == 0) {
 595                 if (mpt->verbose)
 596                         device_printf(mpt->dev,"Already released dma memory\n");
 597                 return;
 598         }
 599
 600         for (i = 0; i < MPT_MAX_REQUESTS(mpt); i++) {
 601                 bus_dmamap_destroy(mpt->buffer_dmat, mpt->request_pool[i].dmap);
 602         }
 603         bus_dmamap_unload(mpt->request_dmat, mpt->request_dmap);
 604         bus_dmamem_free(mpt->request_dmat, mpt->request, mpt->request_dmap);
 605         bus_dma_tag_destroy(mpt->request_dmat);
 606         bus_dma_tag_destroy(mpt->buffer_dmat);
 607         bus_dmamap_unload(mpt->reply_dmat, mpt->reply_dmap);
 608         bus_dmamem_free(mpt->reply_dmat, mpt->reply, mpt->reply_dmap);
 609         bus_dma_tag_destroy(mpt->reply_dmat);
 610         bus_dma_tag_destroy(mpt->parent_dmat);
 611         mpt->reply_dmat = 0;
 612         kfree(mpt->request_pool, M_DEVBUF);
 613         mpt->request_pool = 0;
 614
 615 }
 616
 617
 618
 619 /* Reads modifiable (via PCI transactions) config registers */
 620 static void
 621 mpt_read_config_regs(mpt_softc_t *mpt)
 622 {
 623         mpt->pci_cfg.Command = pci_read_config(mpt->dev, PCIR_COMMAND, 2);
 624         mpt->pci_cfg.LatencyTimer_LineSize =
 625             pci_read_config(mpt->dev, PCIR_CACHELNSZ, 2);
 626         mpt->pci_cfg.IO_BAR = pci_read_config(mpt->dev, PCIR_MAPS, 4);
 627         mpt->pci_cfg.Mem0_BAR[0] = pci_read_config(mpt->dev, PCIR_MAPS+0x4, 4);
 628         mpt->pci_cfg.Mem0_BAR[1] = pci_read_config(mpt->dev, PCIR_MAPS+0x8, 4);
 629         mpt->pci_cfg.Mem1_BAR[0] = pci_read_config(mpt->dev, PCIR_MAPS+0xC, 4);
 630         mpt->pci_cfg.Mem1_BAR[1] = pci_read_config(mpt->dev, PCIR_MAPS+0x10, 4);
 631         mpt->pci_cfg.ROM_BAR = pci_read_config(mpt->dev, PCIR_BIOS, 4);
 632         mpt->pci_cfg.IntLine = pci_read_config(mpt->dev, PCIR_INTLINE, 1);
 633         mpt->pci_cfg.PMCSR = pci_read_config(mpt->dev, 0x44, 4);
 634 }
 635
 636 /* Sets modifiable config registers */
 637 void
 638 mpt_set_config_regs(mpt_softc_t *mpt)
 639 {
 640         u_int32_t val;
 641
 642 #define MPT_CHECK(reg, offset, size)                                    \
 643         val = pci_read_config(mpt->dev, offset, size);                  \
 644         if (mpt->pci_cfg.reg != val) {                                  \
 645                 device_printf(mpt->dev,                                 \
 646                     "Restoring " #reg " to 0x%X from 0x%X\n",           \
 647                     mpt->pci_cfg.reg, val);                             \
 648         }
 649
 650         if (mpt->verbose) {
 651                 MPT_CHECK(Command, PCIR_COMMAND, 2);
 652                 MPT_CHECK(LatencyTimer_LineSize, PCIR_CACHELNSZ, 2);
 653                 MPT_CHECK(IO_BAR, PCIR_MAPS, 4);
 654                 MPT_CHECK(Mem0_BAR[0], PCIR_MAPS+0x4, 4);
 655                 MPT_CHECK(Mem0_BAR[1], PCIR_MAPS+0x8, 4);
 656                 MPT_CHECK(Mem1_BAR[0], PCIR_MAPS+0xC, 4);
 657                 MPT_CHECK(Mem1_BAR[1], PCIR_MAPS+0x10, 4);
 658                 MPT_CHECK(ROM_BAR, PCIR_BIOS, 4);
 659                 MPT_CHECK(IntLine, PCIR_INTLINE, 1);
 660                 MPT_CHECK(PMCSR, 0x44, 4);
 661         }
 662 #undef MPT_CHECK
 663
 664         pci_write_config(mpt->dev, PCIR_COMMAND, mpt->pci_cfg.Command, 2);
 665         pci_write_config(mpt->dev, PCIR_CACHELNSZ,
 666             mpt->pci_cfg.LatencyTimer_LineSize, 2);
 667         pci_write_config(mpt->dev, PCIR_MAPS, mpt->pci_cfg.IO_BAR, 4);
 668         pci_write_config(mpt->dev, PCIR_MAPS+0x4, mpt->pci_cfg.Mem0_BAR[0], 4);
 669         pci_write_config(mpt->dev, PCIR_MAPS+0x8, mpt->pci_cfg.Mem0_BAR[1], 4);
 670         pci_write_config(mpt->dev, PCIR_MAPS+0xC, mpt->pci_cfg.Mem1_BAR[0], 4);
 671         pci_write_config(mpt->dev, PCIR_MAPS+0x10, mpt->pci_cfg.Mem1_BAR[1], 4);
 672         pci_write_config(mpt->dev, PCIR_BIOS, mpt->pci_cfg.ROM_BAR, 4);
 673         pci_write_config(mpt->dev, PCIR_INTLINE, mpt->pci_cfg.IntLine, 1);
 674         pci_write_config(mpt->dev, 0x44, mpt->pci_cfg.PMCSR, 4);
 675 }
 676
 677 static void
 678 mpt_pci_intr(void *arg)
 679 {
 680         mpt_softc_t *mpt = arg;
 681         MPT_LOCK(mpt);
 682         (void) mpt_intr(mpt);
 683         MPT_UNLOCK(mpt);
 684 }