1331c488dSSøren Schmidt /*- 29f82379cSSøren Schmidt * Copyright (c) 1998 - 2008 S�ren Schmidt <sos@FreeBSD.org> 3331c488dSSøren Schmidt * All rights reserved. 4331c488dSSøren Schmidt * 5331c488dSSøren Schmidt * Redistribution and use in source and binary forms, with or without 6331c488dSSøren Schmidt * modification, are permitted provided that the following conditions 7331c488dSSøren Schmidt * are met: 8331c488dSSøren Schmidt * 1. Redistributions of source code must retain the above copyright 9331c488dSSøren Schmidt * notice, this list of conditions and the following disclaimer, 10331c488dSSøren Schmidt * without modification, immediately at the beginning of the file. 11331c488dSSøren Schmidt * 2. Redistributions in binary form must reproduce the above copyright 12331c488dSSøren Schmidt * notice, this list of conditions and the following disclaimer in the 13331c488dSSøren Schmidt * documentation and/or other materials provided with the distribution. 14331c488dSSøren Schmidt * 15331c488dSSøren Schmidt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16331c488dSSøren Schmidt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17331c488dSSøren Schmidt * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18331c488dSSøren Schmidt * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19331c488dSSøren Schmidt * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20331c488dSSøren Schmidt * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21331c488dSSøren Schmidt * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22331c488dSSøren Schmidt * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23331c488dSSøren Schmidt * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24331c488dSSøren Schmidt * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25331c488dSSøren Schmidt */ 26331c488dSSøren Schmidt 27aad970f1SDavid E. O'Brien #include <sys/cdefs.h> 28aad970f1SDavid E. O'Brien __FBSDID("$FreeBSD$"); 29aad970f1SDavid E. O'Brien 307800211bSSøren Schmidt #include "opt_ata.h" 31331c488dSSøren Schmidt #include <sys/param.h> 32331c488dSSøren Schmidt #include <sys/systm.h> 33331c488dSSøren Schmidt #include <sys/kernel.h> 34331c488dSSøren Schmidt #include <sys/module.h> 358ca4df32SSøren Schmidt #include <sys/ata.h> 36331c488dSSøren Schmidt #include <sys/bus.h> 370a3a1935SSøren Schmidt #include <sys/conf.h> 38331c488dSSøren Schmidt #include <sys/malloc.h> 39a7a120f6SSøren Schmidt #include <sys/sema.h> 405fdbb0d2SSøren Schmidt #include <sys/taskqueue.h> 415df3ca78SSøren Schmidt #include <vm/uma.h> 42331c488dSSøren Schmidt #include <machine/stdarg.h> 43331c488dSSøren Schmidt #include <machine/resource.h> 44331c488dSSøren Schmidt #include <machine/bus.h> 45331c488dSSøren Schmidt #include <sys/rman.h> 464fbd232cSWarner Losh #include <dev/pci/pcivar.h> 474fbd232cSWarner Losh #include <dev/pci/pcireg.h> 48331c488dSSøren Schmidt #include <dev/ata/ata-all.h> 49bb5bdd38SSøren Schmidt #include <dev/ata/ata-pci.h> 508ca4df32SSøren Schmidt #include <ata_if.h> 51331c488dSSøren Schmidt 52bb5bdd38SSøren Schmidt /* local vars */ 535bb84bc8SRobert Watson static MALLOC_DEFINE(M_ATAPCI, "ata_pci", "ATA driver PCI"); 54331c488dSSøren Schmidt 5572c2f499SSøren Schmidt /* misc defines */ 5672c2f499SSøren Schmidt #define IOMASK 0xfffffffc 5772c2f499SSøren Schmidt 5813014ca0SSøren Schmidt /* local prototypes */ 5913014ca0SSøren Schmidt static int ata_generic_chipinit(device_t dev); 6013014ca0SSøren Schmidt static void ata_generic_setmode(device_t dev, int mode); 614ee3fbe8SSøren Schmidt 6213014ca0SSøren Schmidt /* 6313014ca0SSøren Schmidt * generic PCI ATA device probe 6413014ca0SSøren Schmidt */ 658ca4df32SSøren Schmidt int 66331c488dSSøren Schmidt ata_pci_probe(device_t dev) 67331c488dSSøren Schmidt { 6813014ca0SSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(dev); 6913014ca0SSøren Schmidt char buffer[64]; 7013014ca0SSøren Schmidt 7113014ca0SSøren Schmidt /* is this a storage class device ? */ 72bb5bdd38SSøren Schmidt if (pci_get_class(dev) != PCIC_STORAGE) 73c6b8ee96SJung-uk Kim return (ENXIO); 74331c488dSSøren Schmidt 7513014ca0SSøren Schmidt /* is this an IDE/ATA type device ? */ 7613014ca0SSøren Schmidt if (pci_get_subclass(dev) != PCIS_STORAGE_IDE) 77c6b8ee96SJung-uk Kim return (ENXIO); 7813014ca0SSøren Schmidt 7913014ca0SSøren Schmidt sprintf(buffer, "%s ATA controller", ata_pcivendor2str(dev)); 8013014ca0SSøren Schmidt device_set_desc_copy(dev, buffer); 8113014ca0SSøren Schmidt ctlr->chipinit = ata_generic_chipinit; 8213014ca0SSøren Schmidt 8313014ca0SSøren Schmidt /* we are a low priority handler */ 84c6b8ee96SJung-uk Kim return (BUS_PROBE_GENERIC); 85bb5bdd38SSøren Schmidt } 86331c488dSSøren Schmidt 878ca4df32SSøren Schmidt int 88331c488dSSøren Schmidt ata_pci_attach(device_t dev) 89331c488dSSøren Schmidt { 90566cf07aSSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(dev); 91d7216f56SAlexander Motin device_t child; 92498e5543SSøren Schmidt u_int32_t cmd; 931b7cfe44SSøren Schmidt int unit; 94331c488dSSøren Schmidt 95566cf07aSSøren Schmidt /* do chipset specific setups only needed once */ 96cb33306fSAlexander Motin ctlr->legacy = ata_legacy(dev); 97cb33306fSAlexander Motin if (ctlr->legacy || pci_read_config(dev, PCIR_BAR(2), 4) & IOMASK) 98566cf07aSSøren Schmidt ctlr->channels = 2; 99566cf07aSSøren Schmidt else 100566cf07aSSøren Schmidt ctlr->channels = 1; 1019f8919f2SAlexander Motin ctlr->ichannels = -1; 10204ff88ceSAlexander Motin ctlr->ch_attach = ata_pci_ch_attach; 10378d15416SAlexander Motin ctlr->ch_detach = ata_pci_ch_detach; 1048ca4df32SSøren Schmidt ctlr->dev = dev; 105566cf07aSSøren Schmidt 106498e5543SSøren Schmidt /* if needed try to enable busmastering */ 107498e5543SSøren Schmidt cmd = pci_read_config(dev, PCIR_COMMAND, 2); 1087800211bSSøren Schmidt if (!(cmd & PCIM_CMD_BUSMASTEREN)) { 1097800211bSSøren Schmidt pci_write_config(dev, PCIR_COMMAND, cmd | PCIM_CMD_BUSMASTEREN, 2); 1107800211bSSøren Schmidt cmd = pci_read_config(dev, PCIR_COMMAND, 2); 1117800211bSSøren Schmidt } 112331c488dSSøren Schmidt 113498e5543SSøren Schmidt /* if busmastering mode "stuck" use it */ 114498e5543SSøren Schmidt if ((cmd & PCIM_CMD_BUSMASTEREN) == PCIM_CMD_BUSMASTEREN) { 115498e5543SSøren Schmidt ctlr->r_type1 = SYS_RES_IOPORT; 116498e5543SSøren Schmidt ctlr->r_rid1 = ATA_BMADDR_RID; 1175f96beb9SNate Lawson ctlr->r_res1 = bus_alloc_resource_any(dev, ctlr->r_type1, &ctlr->r_rid1, 1185f96beb9SNate Lawson RF_ACTIVE); 119331c488dSSøren Schmidt } 120331c488dSSøren Schmidt 121f5f55db3SSøren Schmidt if (ctlr->chipinit(dev)) 122f5f55db3SSøren Schmidt return ENXIO; 123c2833977SSøren Schmidt 124566cf07aSSøren Schmidt /* attach all channels on this controller */ 1256230b63cSSøren Schmidt for (unit = 0; unit < ctlr->channels; unit++) { 1269f8919f2SAlexander Motin if ((ctlr->ichannels & (1 << unit)) == 0) 1279f8919f2SAlexander Motin continue; 128d7216f56SAlexander Motin child = device_add_child(dev, "ata", 129d7216f56SAlexander Motin ((unit == 0 || unit == 1) && ctlr->legacy) ? 130d7216f56SAlexander Motin unit : devclass_find_free_unit(ata_devclass, 2)); 131d7216f56SAlexander Motin if (child == NULL) 132d7216f56SAlexander Motin device_printf(dev, "failed to add ata child device\n"); 133d7216f56SAlexander Motin else 134d7216f56SAlexander Motin device_set_ivars(child, (void *)(intptr_t)unit); 1356230b63cSSøren Schmidt } 1368ca4df32SSøren Schmidt bus_generic_attach(dev); 1378ca4df32SSøren Schmidt return 0; 138f2972d7eSSøren Schmidt } 139498e5543SSøren Schmidt 1408ca4df32SSøren Schmidt int 141498e5543SSøren Schmidt ata_pci_detach(device_t dev) 142498e5543SSøren Schmidt { 143498e5543SSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(dev); 1448ca4df32SSøren Schmidt device_t *children; 1458ca4df32SSøren Schmidt int nchildren, i; 146498e5543SSøren Schmidt 1478ca4df32SSøren Schmidt /* detach & delete all children */ 1488ca4df32SSøren Schmidt if (!device_get_children(dev, &children, &nchildren)) { 1498ca4df32SSøren Schmidt for (i = 0; i < nchildren; i++) 1508ca4df32SSøren Schmidt device_delete_child(dev, children[i]); 1518ca4df32SSøren Schmidt free(children, M_TEMP); 152331c488dSSøren Schmidt } 153331c488dSSøren Schmidt 154498e5543SSøren Schmidt if (ctlr->r_irq) { 155498e5543SSøren Schmidt bus_teardown_intr(dev, ctlr->r_irq, ctlr->handle); 156a3b7c762SAlexander Motin bus_release_resource(dev, SYS_RES_IRQ, ctlr->r_irq_rid, ctlr->r_irq); 157a3b7c762SAlexander Motin if (ctlr->r_irq_rid != ATA_IRQ_RID) 158a3b7c762SAlexander Motin pci_release_msi(dev); 159498e5543SSøren Schmidt } 160498e5543SSøren Schmidt if (ctlr->r_res2) 161498e5543SSøren Schmidt bus_release_resource(dev, ctlr->r_type2, ctlr->r_rid2, ctlr->r_res2); 162498e5543SSøren Schmidt if (ctlr->r_res1) 163498e5543SSøren Schmidt bus_release_resource(dev, ctlr->r_type1, ctlr->r_rid1, ctlr->r_res1); 164498e5543SSøren Schmidt 165498e5543SSøren Schmidt return 0; 166498e5543SSøren Schmidt } 167331c488dSSøren Schmidt 1687aab7e05SSøren Schmidt int 1697aab7e05SSøren Schmidt ata_pci_suspend(device_t dev) 1707aab7e05SSøren Schmidt { 1717aab7e05SSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(dev); 1727aab7e05SSøren Schmidt int error = 0; 1737aab7e05SSøren Schmidt 1747aab7e05SSøren Schmidt bus_generic_suspend(dev); 1757aab7e05SSøren Schmidt if (ctlr->suspend) 1767aab7e05SSøren Schmidt error = ctlr->suspend(dev); 1777aab7e05SSøren Schmidt return error; 1787aab7e05SSøren Schmidt } 1797aab7e05SSøren Schmidt 1807aab7e05SSøren Schmidt int 1817aab7e05SSøren Schmidt ata_pci_resume(device_t dev) 1827aab7e05SSøren Schmidt { 1837aab7e05SSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(dev); 1847aab7e05SSøren Schmidt int error = 0; 1857aab7e05SSøren Schmidt 1867aab7e05SSøren Schmidt if (ctlr->resume) 1877aab7e05SSøren Schmidt error = ctlr->resume(dev); 1887aab7e05SSøren Schmidt bus_generic_resume(dev); 1897aab7e05SSøren Schmidt return error; 1907aab7e05SSøren Schmidt } 1917aab7e05SSøren Schmidt 1928ca4df32SSøren Schmidt struct resource * 193331c488dSSøren Schmidt ata_pci_alloc_resource(device_t dev, device_t child, int type, int *rid, 194331c488dSSøren Schmidt u_long start, u_long end, u_long count, u_int flags) 195331c488dSSøren Schmidt { 1966ddce903SSøren Schmidt struct ata_pci_controller *controller = device_get_softc(dev); 1976ddce903SSøren Schmidt int unit = ((struct ata_channel *)device_get_softc(child))->unit; 198bb5bdd38SSøren Schmidt struct resource *res = NULL; 199331c488dSSøren Schmidt int myrid; 200331c488dSSøren Schmidt 201331c488dSSøren Schmidt if (type == SYS_RES_IOPORT) { 202331c488dSSøren Schmidt switch (*rid) { 203331c488dSSøren Schmidt case ATA_IOADDR_RID: 204cb33306fSAlexander Motin if (controller->legacy) { 2056ddce903SSøren Schmidt start = (unit ? ATA_SECONDARY : ATA_PRIMARY); 206331c488dSSøren Schmidt count = ATA_IOSIZE; 207f2972d7eSSøren Schmidt end = start + count - 1; 208331c488dSSøren Schmidt } 2096230b63cSSøren Schmidt myrid = PCIR_BAR(0) + (unit << 3); 210331c488dSSøren Schmidt res = BUS_ALLOC_RESOURCE(device_get_parent(dev), dev, 211331c488dSSøren Schmidt SYS_RES_IOPORT, &myrid, 212331c488dSSøren Schmidt start, end, count, flags); 213331c488dSSøren Schmidt break; 214331c488dSSøren Schmidt 2150e1eb682SSøren Schmidt case ATA_CTLADDR_RID: 216cb33306fSAlexander Motin if (controller->legacy) { 2170e1eb682SSøren Schmidt start = (unit ? ATA_SECONDARY : ATA_PRIMARY) + ATA_CTLOFFSET; 2180e1eb682SSøren Schmidt count = ATA_CTLIOSIZE; 219f2972d7eSSøren Schmidt end = start + count - 1; 220331c488dSSøren Schmidt } 2216230b63cSSøren Schmidt myrid = PCIR_BAR(1) + (unit << 3); 222331c488dSSøren Schmidt res = BUS_ALLOC_RESOURCE(device_get_parent(dev), dev, 223331c488dSSøren Schmidt SYS_RES_IOPORT, &myrid, 224331c488dSSøren Schmidt start, end, count, flags); 225331c488dSSøren Schmidt break; 226331c488dSSøren Schmidt } 227331c488dSSøren Schmidt } 228331c488dSSøren Schmidt if (type == SYS_RES_IRQ && *rid == ATA_IRQ_RID) { 229cb33306fSAlexander Motin if (controller->legacy) { 2306ddce903SSøren Schmidt int irq = (unit == 0 ? 14 : 15); 231331c488dSSøren Schmidt 232bbccd832SSøren Schmidt res = BUS_ALLOC_RESOURCE(device_get_parent(dev), child, 233468fe0fdSSøren Schmidt SYS_RES_IRQ, rid, irq, irq, 1, flags); 234331c488dSSøren Schmidt } 235bbccd832SSøren Schmidt else 236bbccd832SSøren Schmidt res = controller->r_irq; 237331c488dSSøren Schmidt } 238bbccd832SSøren Schmidt return res; 239331c488dSSøren Schmidt } 240331c488dSSøren Schmidt 2418ca4df32SSøren Schmidt int 242331c488dSSøren Schmidt ata_pci_release_resource(device_t dev, device_t child, int type, int rid, 243331c488dSSøren Schmidt struct resource *r) 244331c488dSSøren Schmidt { 245cb33306fSAlexander Motin struct ata_pci_controller *controller = device_get_softc(dev); 2466ddce903SSøren Schmidt int unit = ((struct ata_channel *)device_get_softc(child))->unit; 247331c488dSSøren Schmidt 248331c488dSSøren Schmidt if (type == SYS_RES_IOPORT) { 249331c488dSSøren Schmidt switch (rid) { 250331c488dSSøren Schmidt case ATA_IOADDR_RID: 251b5a5e99dSSøren Schmidt return BUS_RELEASE_RESOURCE(device_get_parent(dev), dev, 2526230b63cSSøren Schmidt SYS_RES_IOPORT, 2536230b63cSSøren Schmidt PCIR_BAR(0) + (unit << 3), r); 254331c488dSSøren Schmidt break; 255331c488dSSøren Schmidt 2560e1eb682SSøren Schmidt case ATA_CTLADDR_RID: 257b5a5e99dSSøren Schmidt return BUS_RELEASE_RESOURCE(device_get_parent(dev), dev, 2586230b63cSSøren Schmidt SYS_RES_IOPORT, 2596230b63cSSøren Schmidt PCIR_BAR(1) + (unit << 3), r); 260331c488dSSøren Schmidt break; 261331c488dSSøren Schmidt default: 262331c488dSSøren Schmidt return ENOENT; 263331c488dSSøren Schmidt } 264331c488dSSøren Schmidt } 265331c488dSSøren Schmidt if (type == SYS_RES_IRQ) { 266331c488dSSøren Schmidt if (rid != ATA_IRQ_RID) 267331c488dSSøren Schmidt return ENOENT; 268331c488dSSøren Schmidt 269cb33306fSAlexander Motin if (controller->legacy) { 270b5a5e99dSSøren Schmidt return BUS_RELEASE_RESOURCE(device_get_parent(dev), child, 271b5a5e99dSSøren Schmidt SYS_RES_IRQ, rid, r); 272331c488dSSøren Schmidt } 273bb5bdd38SSøren Schmidt else 274331c488dSSøren Schmidt return 0; 275331c488dSSøren Schmidt } 276331c488dSSøren Schmidt return EINVAL; 277331c488dSSøren Schmidt } 278331c488dSSøren Schmidt 2798ca4df32SSøren Schmidt int 280331c488dSSøren Schmidt ata_pci_setup_intr(device_t dev, device_t child, struct resource *irq, 281ef544f63SPaolo Pisati int flags, driver_filter_t *filter, driver_intr_t *function, 282ef544f63SPaolo Pisati void *argument, void **cookiep) 283331c488dSSøren Schmidt { 284cb33306fSAlexander Motin struct ata_pci_controller *controller = device_get_softc(dev); 285cb33306fSAlexander Motin 286cb33306fSAlexander Motin if (controller->legacy) { 287331c488dSSøren Schmidt return BUS_SETUP_INTR(device_get_parent(dev), child, irq, 288ef544f63SPaolo Pisati flags, filter, function, argument, cookiep); 289331c488dSSøren Schmidt } 290bb5bdd38SSøren Schmidt else { 291bb5bdd38SSøren Schmidt struct ata_pci_controller *controller = device_get_softc(dev); 292bb5bdd38SSøren Schmidt int unit = ((struct ata_channel *)device_get_softc(child))->unit; 293bb5bdd38SSøren Schmidt 294ef544f63SPaolo Pisati if (filter != NULL) { 295ef544f63SPaolo Pisati printf("ata-pci.c: we cannot use a filter here\n"); 296ef544f63SPaolo Pisati return (EINVAL); 297ef544f63SPaolo Pisati } 298bb5bdd38SSøren Schmidt controller->interrupt[unit].function = function; 299bb5bdd38SSøren Schmidt controller->interrupt[unit].argument = argument; 300bb5bdd38SSøren Schmidt *cookiep = controller; 301bb5bdd38SSøren Schmidt return 0; 302bb5bdd38SSøren Schmidt } 303331c488dSSøren Schmidt } 304331c488dSSøren Schmidt 3058ca4df32SSøren Schmidt int 306331c488dSSøren Schmidt ata_pci_teardown_intr(device_t dev, device_t child, struct resource *irq, 307331c488dSSøren Schmidt void *cookie) 308331c488dSSøren Schmidt { 309cb33306fSAlexander Motin struct ata_pci_controller *controller = device_get_softc(dev); 310cb33306fSAlexander Motin 311cb33306fSAlexander Motin if (controller->legacy) { 312331c488dSSøren Schmidt return BUS_TEARDOWN_INTR(device_get_parent(dev), child, irq, cookie); 313331c488dSSøren Schmidt } 3142e6c2a10SSøren Schmidt else { 3152e6c2a10SSøren Schmidt struct ata_pci_controller *controller = device_get_softc(dev); 3162e6c2a10SSøren Schmidt int unit = ((struct ata_channel *)device_get_softc(child))->unit; 3172e6c2a10SSøren Schmidt 3182e6c2a10SSøren Schmidt controller->interrupt[unit].function = NULL; 3192e6c2a10SSøren Schmidt controller->interrupt[unit].argument = NULL; 320bb5bdd38SSøren Schmidt return 0; 321331c488dSSøren Schmidt } 3222e6c2a10SSøren Schmidt } 323331c488dSSøren Schmidt 32413014ca0SSøren Schmidt static void 32513014ca0SSøren Schmidt ata_generic_setmode(device_t dev, int mode) 32613014ca0SSøren Schmidt { 32713014ca0SSøren Schmidt struct ata_device *atadev = device_get_softc(dev); 32813014ca0SSøren Schmidt 32913014ca0SSøren Schmidt mode = ata_limit_mode(dev, mode, ATA_UDMA2); 33013014ca0SSøren Schmidt mode = ata_check_80pin(dev, mode); 33113014ca0SSøren Schmidt if (!ata_controlcmd(dev, ATA_SETFEATURES, ATA_SF_SETXFER, 0, mode)) 33213014ca0SSøren Schmidt atadev->mode = mode; 33313014ca0SSøren Schmidt } 33413014ca0SSøren Schmidt 33513014ca0SSøren Schmidt static int 33613014ca0SSøren Schmidt ata_generic_chipinit(device_t dev) 33713014ca0SSøren Schmidt { 33813014ca0SSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(dev); 33913014ca0SSøren Schmidt 34013014ca0SSøren Schmidt if (ata_setup_interrupt(dev, ata_generic_intr)) 34113014ca0SSøren Schmidt return ENXIO; 34213014ca0SSøren Schmidt ctlr->setmode = ata_generic_setmode; 34313014ca0SSøren Schmidt return 0; 34413014ca0SSøren Schmidt } 34513014ca0SSøren Schmidt 346b0a7e6a5SSøren Schmidt int 34704ff88ceSAlexander Motin ata_pci_ch_attach(device_t dev) 348566cf07aSSøren Schmidt { 349566cf07aSSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 350bbccd832SSøren Schmidt struct ata_channel *ch = device_get_softc(dev); 3510e1eb682SSøren Schmidt struct resource *io = NULL, *ctlio = NULL; 352566cf07aSSøren Schmidt int i, rid; 353566cf07aSSøren Schmidt 354566cf07aSSøren Schmidt rid = ATA_IOADDR_RID; 355ecd6c15dSSøren Schmidt if (!(io = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE))) 356566cf07aSSøren Schmidt return ENXIO; 357566cf07aSSøren Schmidt 3580e1eb682SSøren Schmidt rid = ATA_CTLADDR_RID; 359ecd6c15dSSøren Schmidt if (!(ctlio = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid,RF_ACTIVE))){ 360566cf07aSSøren Schmidt bus_release_resource(dev, SYS_RES_IOPORT, ATA_IOADDR_RID, io); 361566cf07aSSøren Schmidt return ENXIO; 362566cf07aSSøren Schmidt } 363566cf07aSSøren Schmidt 36404ff88ceSAlexander Motin ata_pci_dmainit(dev); 36504ff88ceSAlexander Motin 3660e1eb682SSøren Schmidt for (i = ATA_DATA; i <= ATA_COMMAND; i ++) { 367566cf07aSSøren Schmidt ch->r_io[i].res = io; 368566cf07aSSøren Schmidt ch->r_io[i].offset = i; 369566cf07aSSøren Schmidt } 3700e1eb682SSøren Schmidt ch->r_io[ATA_CONTROL].res = ctlio; 371cb33306fSAlexander Motin ch->r_io[ATA_CONTROL].offset = ctlr->legacy ? 0 : 2; 3721b39bd24SSøren Schmidt ch->r_io[ATA_IDX_ADDR].res = io; 3730068f98fSSøren Schmidt ata_default_registers(dev); 374498e5543SSøren Schmidt if (ctlr->r_res1) { 375566cf07aSSøren Schmidt for (i = ATA_BMCMD_PORT; i <= ATA_BMDTP_PORT; i++) { 376498e5543SSøren Schmidt ch->r_io[i].res = ctlr->r_res1; 377566cf07aSSøren Schmidt ch->r_io[i].offset = (i - ATA_BMCMD_PORT) + (ch->unit*ATA_BMIOSIZE); 378566cf07aSSøren Schmidt } 379566cf07aSSøren Schmidt } 380f2972d7eSSøren Schmidt 381f5f55db3SSøren Schmidt ata_pci_hw(dev); 382566cf07aSSøren Schmidt return 0; 383566cf07aSSøren Schmidt } 384566cf07aSSøren Schmidt 385a7c33e78SSøren Schmidt int 38678d15416SAlexander Motin ata_pci_ch_detach(device_t dev) 38778d15416SAlexander Motin { 38878d15416SAlexander Motin struct ata_channel *ch = device_get_softc(dev); 38978d15416SAlexander Motin 39078d15416SAlexander Motin ata_pci_dmafini(dev); 39178d15416SAlexander Motin 39278d15416SAlexander Motin bus_release_resource(dev, SYS_RES_IOPORT, ATA_CTLADDR_RID, 39378d15416SAlexander Motin ch->r_io[ATA_CONTROL].res); 39478d15416SAlexander Motin bus_release_resource(dev, SYS_RES_IOPORT, ATA_IOADDR_RID, 39578d15416SAlexander Motin ch->r_io[ATA_IDX_ADDR].res); 39678d15416SAlexander Motin 39778d15416SAlexander Motin return (0); 39878d15416SAlexander Motin } 39978d15416SAlexander Motin 40078d15416SAlexander Motin int 401f5f55db3SSøren Schmidt ata_pci_status(device_t dev) 402f5f55db3SSøren Schmidt { 403cb33306fSAlexander Motin struct ata_pci_controller *controller = 404cb33306fSAlexander Motin device_get_softc(device_get_parent(dev)); 405f5f55db3SSøren Schmidt struct ata_channel *ch = device_get_softc(dev); 406f5f55db3SSøren Schmidt 407cb33306fSAlexander Motin if ((dumping || !controller->legacy) && 4089f82379cSSøren Schmidt ((ch->flags & ATA_ALWAYS_DMASTAT) || 4099f82379cSSøren Schmidt (ch->dma.flags & ATA_DMA_ACTIVE))) { 410f5f55db3SSøren Schmidt int bmstat = ATA_IDX_INB(ch, ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK; 411f5f55db3SSøren Schmidt 412f5f55db3SSøren Schmidt if ((bmstat & (ATA_BMSTAT_ACTIVE | ATA_BMSTAT_INTERRUPT)) != 413f5f55db3SSøren Schmidt ATA_BMSTAT_INTERRUPT) 414f5f55db3SSøren Schmidt return 0; 415f5f55db3SSøren Schmidt ATA_IDX_OUTB(ch, ATA_BMSTAT_PORT, bmstat & ~ATA_BMSTAT_ERROR); 416f5f55db3SSøren Schmidt DELAY(1); 417f5f55db3SSøren Schmidt } 418f5f55db3SSøren Schmidt if (ATA_IDX_INB(ch, ATA_ALTSTAT) & ATA_S_BUSY) { 419f5f55db3SSøren Schmidt DELAY(100); 420f5f55db3SSøren Schmidt if (ATA_IDX_INB(ch, ATA_ALTSTAT) & ATA_S_BUSY) 421f5f55db3SSøren Schmidt return 0; 422f5f55db3SSøren Schmidt } 423f5f55db3SSøren Schmidt return 1; 424f5f55db3SSøren Schmidt } 425f5f55db3SSøren Schmidt 4269f82379cSSøren Schmidt void 4279f82379cSSøren Schmidt ata_pci_hw(device_t dev) 428566cf07aSSøren Schmidt { 4299f82379cSSøren Schmidt struct ata_channel *ch = device_get_softc(dev); 4309f82379cSSøren Schmidt 4319f82379cSSøren Schmidt ata_generic_hw(dev); 4329f82379cSSøren Schmidt ch->hw.status = ata_pci_status; 4339f82379cSSøren Schmidt } 4349f82379cSSøren Schmidt 4359f82379cSSøren Schmidt static int 4369f82379cSSøren Schmidt ata_pci_dmastart(struct ata_request *request) 4379f82379cSSøren Schmidt { 4389f82379cSSøren Schmidt struct ata_channel *ch = device_get_softc(request->parent); 4399f82379cSSøren Schmidt 4409f82379cSSøren Schmidt ATA_DEBUG_RQ(request, "dmastart"); 4410068f98fSSøren Schmidt 442566cf07aSSøren Schmidt ATA_IDX_OUTB(ch, ATA_BMSTAT_PORT, (ATA_IDX_INB(ch, ATA_BMSTAT_PORT) | 443566cf07aSSøren Schmidt (ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR))); 444104c094eSSøren Schmidt ATA_IDX_OUTL(ch, ATA_BMDTP_PORT, request->dma->sg_bus); 4459f82379cSSøren Schmidt ch->dma.flags |= ATA_DMA_ACTIVE; 446566cf07aSSøren Schmidt ATA_IDX_OUTB(ch, ATA_BMCMD_PORT, 44745bf968aSSøren Schmidt (ATA_IDX_INB(ch, ATA_BMCMD_PORT) & ~ATA_BMCMD_WRITE_READ) | 4489f82379cSSøren Schmidt ((request->flags & ATA_R_READ) ? ATA_BMCMD_WRITE_READ : 0)| 44980344be5SSøren Schmidt ATA_BMCMD_START_STOP); 450566cf07aSSøren Schmidt return 0; 451566cf07aSSøren Schmidt } 452566cf07aSSøren Schmidt 453566cf07aSSøren Schmidt static int 4549f82379cSSøren Schmidt ata_pci_dmastop(struct ata_request *request) 455566cf07aSSøren Schmidt { 4569f82379cSSøren Schmidt struct ata_channel *ch = device_get_softc(request->parent); 457566cf07aSSøren Schmidt int error; 458566cf07aSSøren Schmidt 4599f82379cSSøren Schmidt ATA_DEBUG_RQ(request, "dmastop"); 4609f82379cSSøren Schmidt 461566cf07aSSøren Schmidt ATA_IDX_OUTB(ch, ATA_BMCMD_PORT, 462566cf07aSSøren Schmidt ATA_IDX_INB(ch, ATA_BMCMD_PORT) & ~ATA_BMCMD_START_STOP); 4639f82379cSSøren Schmidt ch->dma.flags &= ~ATA_DMA_ACTIVE; 464c5b2c44cSSøren Schmidt error = ATA_IDX_INB(ch, ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK; 465566cf07aSSøren Schmidt ATA_IDX_OUTB(ch, ATA_BMSTAT_PORT, ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR); 4665fdbb0d2SSøren Schmidt return error; 467566cf07aSSøren Schmidt } 468566cf07aSSøren Schmidt 4696419d0b0SSøren Schmidt static void 470eeda55ceSSøren Schmidt ata_pci_dmareset(device_t dev) 471eeda55ceSSøren Schmidt { 472eeda55ceSSøren Schmidt struct ata_channel *ch = device_get_softc(dev); 4739f82379cSSøren Schmidt struct ata_request *request; 474eeda55ceSSøren Schmidt 475eeda55ceSSøren Schmidt ATA_IDX_OUTB(ch, ATA_BMCMD_PORT, 476eeda55ceSSøren Schmidt ATA_IDX_INB(ch, ATA_BMCMD_PORT) & ~ATA_BMCMD_START_STOP); 4779f82379cSSøren Schmidt ch->dma.flags &= ~ATA_DMA_ACTIVE; 478eeda55ceSSøren Schmidt ATA_IDX_OUTB(ch, ATA_BMSTAT_PORT, ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR); 4799f82379cSSøren Schmidt if ((request = ch->running)) { 480ebbb35baSAlexander Motin device_printf(dev, "DMA reset calling unload\n"); 4819f82379cSSøren Schmidt ch->dma.unload(request); 4829f82379cSSøren Schmidt } 483eeda55ceSSøren Schmidt } 484eeda55ceSSøren Schmidt 485e3989d3eSSøren Schmidt void 4860068f98fSSøren Schmidt ata_pci_dmainit(device_t dev) 487566cf07aSSøren Schmidt { 4880068f98fSSøren Schmidt struct ata_channel *ch = device_get_softc(dev); 4890068f98fSSøren Schmidt 4900068f98fSSøren Schmidt ata_dmainit(dev); 4919f82379cSSøren Schmidt ch->dma.start = ata_pci_dmastart; 4929f82379cSSøren Schmidt ch->dma.stop = ata_pci_dmastop; 4939f82379cSSøren Schmidt ch->dma.reset = ata_pci_dmareset; 494566cf07aSSøren Schmidt } 495566cf07aSSøren Schmidt 49678d15416SAlexander Motin void 49778d15416SAlexander Motin ata_pci_dmafini(device_t dev) 49878d15416SAlexander Motin { 49978d15416SAlexander Motin 50078d15416SAlexander Motin ata_dmafini(dev); 50178d15416SAlexander Motin } 502200c7605SSøren Schmidt 503331c488dSSøren Schmidt static device_method_t ata_pci_methods[] = { 504331c488dSSøren Schmidt /* device interface */ 505331c488dSSøren Schmidt DEVMETHOD(device_probe, ata_pci_probe), 506331c488dSSøren Schmidt DEVMETHOD(device_attach, ata_pci_attach), 507498e5543SSøren Schmidt DEVMETHOD(device_detach, ata_pci_detach), 5087aab7e05SSøren Schmidt DEVMETHOD(device_suspend, ata_pci_suspend), 5097aab7e05SSøren Schmidt DEVMETHOD(device_resume, ata_pci_resume), 510331c488dSSøren Schmidt DEVMETHOD(device_shutdown, bus_generic_shutdown), 511331c488dSSøren Schmidt 512331c488dSSøren Schmidt /* bus methods */ 513331c488dSSøren Schmidt DEVMETHOD(bus_alloc_resource, ata_pci_alloc_resource), 514331c488dSSøren Schmidt DEVMETHOD(bus_release_resource, ata_pci_release_resource), 515331c488dSSøren Schmidt DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 516331c488dSSøren Schmidt DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 517331c488dSSøren Schmidt DEVMETHOD(bus_setup_intr, ata_pci_setup_intr), 518331c488dSSøren Schmidt DEVMETHOD(bus_teardown_intr, ata_pci_teardown_intr), 5198ca4df32SSøren Schmidt 520331c488dSSøren Schmidt { 0, 0 } 521331c488dSSøren Schmidt }; 522331c488dSSøren Schmidt 52313014ca0SSøren Schmidt devclass_t ata_pci_devclass; 5248ca4df32SSøren Schmidt 525331c488dSSøren Schmidt static driver_t ata_pci_driver = { 526331c488dSSøren Schmidt "atapci", 527331c488dSSøren Schmidt ata_pci_methods, 5286ddce903SSøren Schmidt sizeof(struct ata_pci_controller), 529331c488dSSøren Schmidt }; 530331c488dSSøren Schmidt 53113014ca0SSøren Schmidt DRIVER_MODULE(atapci, pci, ata_pci_driver, ata_pci_devclass, 0, 0); 5328ca4df32SSøren Schmidt MODULE_VERSION(atapci, 1); 5338ca4df32SSøren Schmidt MODULE_DEPEND(atapci, ata, 1, 1, 1); 534331c488dSSøren Schmidt 535331c488dSSøren Schmidt static int 5365a5b148dSSøren Schmidt ata_pcichannel_probe(device_t dev) 537331c488dSSøren Schmidt { 5388ca4df32SSøren Schmidt char buffer[32]; 539331c488dSSøren Schmidt 540d7216f56SAlexander Motin sprintf(buffer, "ATA channel %d", (int)(intptr_t)device_get_ivars(dev)); 5418ca4df32SSøren Schmidt device_set_desc_copy(dev, buffer); 5428ca4df32SSøren Schmidt 543d53fc3e4SSøren Schmidt return ata_probe(dev); 544d53fc3e4SSøren Schmidt } 545d53fc3e4SSøren Schmidt 546d53fc3e4SSøren Schmidt static int 5475a5b148dSSøren Schmidt ata_pcichannel_attach(device_t dev) 548d53fc3e4SSøren Schmidt { 549d53fc3e4SSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 550d7216f56SAlexander Motin struct ata_channel *ch = device_get_softc(dev); 551d53fc3e4SSøren Schmidt int error; 552d53fc3e4SSøren Schmidt 553b50bb79cSAlexander Motin if (ch->attached) 554b50bb79cSAlexander Motin return (0); 555b50bb79cSAlexander Motin ch->attached = 1; 556d7216f56SAlexander Motin 557d7216f56SAlexander Motin ch->unit = (intptr_t)device_get_ivars(dev); 558d7216f56SAlexander Motin 5594c10f2e6SAlexander Motin resource_int_value(device_get_name(dev), 5604c10f2e6SAlexander Motin device_get_unit(dev), "pm_level", &ch->pm_level); 5614c10f2e6SAlexander Motin 56204ff88ceSAlexander Motin if ((error = ctlr->ch_attach(dev))) 563ca5d21e9SSøren Schmidt return error; 564ca5d21e9SSøren Schmidt 565082b99a8SSøren Schmidt return ata_attach(dev); 566331c488dSSøren Schmidt } 567331c488dSSøren Schmidt 568d53fc3e4SSøren Schmidt static int 5695a5b148dSSøren Schmidt ata_pcichannel_detach(device_t dev) 570d53fc3e4SSøren Schmidt { 57104ff88ceSAlexander Motin struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 572b50bb79cSAlexander Motin struct ata_channel *ch = device_get_softc(dev); 573d53fc3e4SSøren Schmidt int error; 574d53fc3e4SSøren Schmidt 575b50bb79cSAlexander Motin if (!ch->attached) 576b50bb79cSAlexander Motin return (0); 577b50bb79cSAlexander Motin ch->attached = 0; 578b50bb79cSAlexander Motin 579d53fc3e4SSøren Schmidt if ((error = ata_detach(dev))) 580d53fc3e4SSøren Schmidt return error; 581d53fc3e4SSøren Schmidt 58204ff88ceSAlexander Motin if (ctlr->ch_detach) 58304ff88ceSAlexander Motin return (ctlr->ch_detach(dev)); 584bbccd832SSøren Schmidt 58504ff88ceSAlexander Motin return (0); 586d53fc3e4SSøren Schmidt } 58779ca9100SAlexander Motin static int 58879ca9100SAlexander Motin ata_pcichannel_suspend(device_t dev) 58979ca9100SAlexander Motin { 5909cf4fe2eSAlexander Motin struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 59179ca9100SAlexander Motin struct ata_channel *ch = device_get_softc(dev); 5929cf4fe2eSAlexander Motin int error; 59379ca9100SAlexander Motin 59479ca9100SAlexander Motin if (!ch->attached) 59579ca9100SAlexander Motin return (0); 59679ca9100SAlexander Motin 5979cf4fe2eSAlexander Motin if ((error = ata_suspend(dev))) 5989cf4fe2eSAlexander Motin return (error); 5999cf4fe2eSAlexander Motin 6009cf4fe2eSAlexander Motin if (ctlr->ch_suspend != NULL && (error = ctlr->ch_suspend(dev))) 6019cf4fe2eSAlexander Motin return (error); 6029cf4fe2eSAlexander Motin 6039cf4fe2eSAlexander Motin return (0); 60479ca9100SAlexander Motin } 60579ca9100SAlexander Motin 60679ca9100SAlexander Motin static int 60779ca9100SAlexander Motin ata_pcichannel_resume(device_t dev) 60879ca9100SAlexander Motin { 6099cf4fe2eSAlexander Motin struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 61079ca9100SAlexander Motin struct ata_channel *ch = device_get_softc(dev); 6119cf4fe2eSAlexander Motin int error; 61279ca9100SAlexander Motin 61379ca9100SAlexander Motin if (!ch->attached) 61479ca9100SAlexander Motin return (0); 61579ca9100SAlexander Motin 6169cf4fe2eSAlexander Motin if (ctlr->ch_resume != NULL && (error = ctlr->ch_resume(dev))) 6179cf4fe2eSAlexander Motin return (error); 6189cf4fe2eSAlexander Motin 61979ca9100SAlexander Motin return ata_resume(dev); 62079ca9100SAlexander Motin } 62179ca9100SAlexander Motin 622d53fc3e4SSøren Schmidt 6235a5b148dSSøren Schmidt static int 6245a5b148dSSøren Schmidt ata_pcichannel_locking(device_t dev, int mode) 6255a5b148dSSøren Schmidt { 6265a5b148dSSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 6275a5b148dSSøren Schmidt struct ata_channel *ch = device_get_softc(dev); 6285a5b148dSSøren Schmidt 6295a5b148dSSøren Schmidt if (ctlr->locking) 6300068f98fSSøren Schmidt return ctlr->locking(dev, mode); 6315a5b148dSSøren Schmidt else 6325a5b148dSSøren Schmidt return ch->unit; 6335a5b148dSSøren Schmidt } 6345a5b148dSSøren Schmidt 6355a5b148dSSøren Schmidt static void 6365a5b148dSSøren Schmidt ata_pcichannel_reset(device_t dev) 6375a5b148dSSøren Schmidt { 6385a5b148dSSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 6395a5b148dSSøren Schmidt struct ata_channel *ch = device_get_softc(dev); 6405a5b148dSSøren Schmidt 641eeda55ceSSøren Schmidt /* if DMA engine present reset it */ 6429f82379cSSøren Schmidt if (ch->dma.reset) 6439f82379cSSøren Schmidt ch->dma.reset(dev); 644b0a7e6a5SSøren Schmidt 645b0a7e6a5SSøren Schmidt /* reset the controller HW */ 6465a5b148dSSøren Schmidt if (ctlr->reset) 6470068f98fSSøren Schmidt ctlr->reset(dev); 6488dad6b7bSSøren Schmidt else 6490068f98fSSøren Schmidt ata_generic_reset(dev); 6505a5b148dSSøren Schmidt } 6515a5b148dSSøren Schmidt 6525a5b148dSSøren Schmidt static void 6535a5b148dSSøren Schmidt ata_pcichannel_setmode(device_t parent, device_t dev) 6545a5b148dSSøren Schmidt { 6555a5b148dSSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(GRANDPARENT(dev)); 6565a5b148dSSøren Schmidt struct ata_device *atadev = device_get_softc(dev); 6575a5b148dSSøren Schmidt int mode = atadev->mode; 6585a5b148dSSøren Schmidt 6590068f98fSSøren Schmidt ctlr->setmode(dev, ATA_PIO_MAX); 6605a5b148dSSøren Schmidt if (mode >= ATA_DMA) 6610068f98fSSøren Schmidt ctlr->setmode(dev, mode); 6625a5b148dSSøren Schmidt } 6635a5b148dSSøren Schmidt 6645a5b148dSSøren Schmidt static device_method_t ata_pcichannel_methods[] = { 665331c488dSSøren Schmidt /* device interface */ 6665a5b148dSSøren Schmidt DEVMETHOD(device_probe, ata_pcichannel_probe), 6675a5b148dSSøren Schmidt DEVMETHOD(device_attach, ata_pcichannel_attach), 6685a5b148dSSøren Schmidt DEVMETHOD(device_detach, ata_pcichannel_detach), 6698ca4df32SSøren Schmidt DEVMETHOD(device_shutdown, bus_generic_shutdown), 67079ca9100SAlexander Motin DEVMETHOD(device_suspend, ata_pcichannel_suspend), 67179ca9100SAlexander Motin DEVMETHOD(device_resume, ata_pcichannel_resume), 6725a5b148dSSøren Schmidt 6735a5b148dSSøren Schmidt /* ATA methods */ 6745a5b148dSSøren Schmidt DEVMETHOD(ata_setmode, ata_pcichannel_setmode), 6755a5b148dSSøren Schmidt DEVMETHOD(ata_locking, ata_pcichannel_locking), 6765a5b148dSSøren Schmidt DEVMETHOD(ata_reset, ata_pcichannel_reset), 6775a5b148dSSøren Schmidt 678331c488dSSøren Schmidt { 0, 0 } 679331c488dSSøren Schmidt }; 680331c488dSSøren Schmidt 6815a5b148dSSøren Schmidt driver_t ata_pcichannel_driver = { 682331c488dSSøren Schmidt "ata", 6835a5b148dSSøren Schmidt ata_pcichannel_methods, 6846ddce903SSøren Schmidt sizeof(struct ata_channel), 685331c488dSSøren Schmidt }; 686331c488dSSøren Schmidt 6875a5b148dSSøren Schmidt DRIVER_MODULE(ata, atapci, ata_pcichannel_driver, ata_devclass, 0, 0); 68813014ca0SSøren Schmidt 68913014ca0SSøren Schmidt 69013014ca0SSøren Schmidt /* 69113014ca0SSøren Schmidt * misc support fucntions 69213014ca0SSøren Schmidt */ 69313014ca0SSøren Schmidt int 69413014ca0SSøren Schmidt ata_legacy(device_t dev) 69513014ca0SSøren Schmidt { 69613014ca0SSøren Schmidt return (((pci_read_config(dev, PCIR_PROGIF, 1)&PCIP_STORAGE_IDE_MASTERDEV)&& 69713014ca0SSøren Schmidt ((pci_read_config(dev, PCIR_PROGIF, 1) & 69813014ca0SSøren Schmidt (PCIP_STORAGE_IDE_MODEPRIM | PCIP_STORAGE_IDE_MODESEC)) != 69913014ca0SSøren Schmidt (PCIP_STORAGE_IDE_MODEPRIM | PCIP_STORAGE_IDE_MODESEC))) || 70013014ca0SSøren Schmidt (!pci_read_config(dev, PCIR_BAR(0), 4) && 70113014ca0SSøren Schmidt !pci_read_config(dev, PCIR_BAR(1), 4) && 70213014ca0SSøren Schmidt !pci_read_config(dev, PCIR_BAR(2), 4) && 70313014ca0SSøren Schmidt !pci_read_config(dev, PCIR_BAR(3), 4) && 70413014ca0SSøren Schmidt !pci_read_config(dev, PCIR_BAR(5), 4))); 70513014ca0SSøren Schmidt } 70613014ca0SSøren Schmidt 70713014ca0SSøren Schmidt void 70813014ca0SSøren Schmidt ata_generic_intr(void *data) 70913014ca0SSøren Schmidt { 71013014ca0SSøren Schmidt struct ata_pci_controller *ctlr = data; 71113014ca0SSøren Schmidt struct ata_channel *ch; 71213014ca0SSøren Schmidt int unit; 71313014ca0SSøren Schmidt 71413014ca0SSøren Schmidt for (unit = 0; unit < ctlr->channels; unit++) { 71513014ca0SSøren Schmidt if ((ch = ctlr->interrupt[unit].argument)) 71613014ca0SSøren Schmidt ctlr->interrupt[unit].function(ch); 71713014ca0SSøren Schmidt } 71813014ca0SSøren Schmidt } 71913014ca0SSøren Schmidt 72013014ca0SSøren Schmidt int 72113014ca0SSøren Schmidt ata_setup_interrupt(device_t dev, void *intr_func) 72213014ca0SSøren Schmidt { 72313014ca0SSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(dev); 724a3b7c762SAlexander Motin int i, msi = 0; 72513014ca0SSøren Schmidt 726cb33306fSAlexander Motin if (!ctlr->legacy) { 727a3b7c762SAlexander Motin if (resource_int_value(device_get_name(dev), 728a3b7c762SAlexander Motin device_get_unit(dev), "msi", &i) == 0 && i != 0) 729a3b7c762SAlexander Motin msi = 1; 730a3b7c762SAlexander Motin if (msi && pci_msi_count(dev) > 0 && pci_alloc_msi(dev, &msi) == 0) { 731a3b7c762SAlexander Motin ctlr->r_irq_rid = 0x1; 732a3b7c762SAlexander Motin } else { 733a3b7c762SAlexander Motin ctlr->r_irq_rid = ATA_IRQ_RID; 734a3b7c762SAlexander Motin } 735a3b7c762SAlexander Motin if (!(ctlr->r_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, 736a3b7c762SAlexander Motin &ctlr->r_irq_rid, RF_SHAREABLE | RF_ACTIVE))) { 73713014ca0SSøren Schmidt device_printf(dev, "unable to map interrupt\n"); 73813014ca0SSøren Schmidt return ENXIO; 73913014ca0SSøren Schmidt } 74013014ca0SSøren Schmidt if ((bus_setup_intr(dev, ctlr->r_irq, ATA_INTR_FLAGS, NULL, 74113014ca0SSøren Schmidt intr_func, ctlr, &ctlr->handle))) { 74213014ca0SSøren Schmidt /* SOS XXX release r_irq */ 74313014ca0SSøren Schmidt device_printf(dev, "unable to setup interrupt\n"); 74413014ca0SSøren Schmidt return ENXIO; 74513014ca0SSøren Schmidt } 74613014ca0SSøren Schmidt } 74713014ca0SSøren Schmidt return 0; 74813014ca0SSøren Schmidt } 74913014ca0SSøren Schmidt 75013014ca0SSøren Schmidt void 75113014ca0SSøren Schmidt ata_set_desc(device_t dev) 75213014ca0SSøren Schmidt { 75313014ca0SSøren Schmidt struct ata_pci_controller *ctlr = device_get_softc(dev); 75413014ca0SSøren Schmidt char buffer[128]; 75513014ca0SSøren Schmidt 75613014ca0SSøren Schmidt sprintf(buffer, "%s %s %s controller", 75713014ca0SSøren Schmidt ata_pcivendor2str(dev), ctlr->chip->text, 75813014ca0SSøren Schmidt ata_mode2str(ctlr->chip->max_dma)); 75913014ca0SSøren Schmidt device_set_desc_copy(dev, buffer); 76013014ca0SSøren Schmidt } 76113014ca0SSøren Schmidt 76213014ca0SSøren Schmidt struct ata_chip_id * 76313014ca0SSøren Schmidt ata_match_chip(device_t dev, struct ata_chip_id *index) 76413014ca0SSøren Schmidt { 7653388ca6bSJung-uk Kim uint32_t devid; 7663388ca6bSJung-uk Kim uint8_t revid; 7673388ca6bSJung-uk Kim 7683388ca6bSJung-uk Kim devid = pci_get_devid(dev); 7693388ca6bSJung-uk Kim revid = pci_get_revid(dev); 77013014ca0SSøren Schmidt while (index->chipid != 0) { 7713388ca6bSJung-uk Kim if (devid == index->chipid && revid >= index->chiprev) 7723388ca6bSJung-uk Kim return (index); 77313014ca0SSøren Schmidt index++; 77413014ca0SSøren Schmidt } 7753388ca6bSJung-uk Kim return (NULL); 77613014ca0SSøren Schmidt } 77713014ca0SSøren Schmidt 77813014ca0SSøren Schmidt struct ata_chip_id * 77913014ca0SSøren Schmidt ata_find_chip(device_t dev, struct ata_chip_id *index, int slot) 78013014ca0SSøren Schmidt { 7817267edacSJung-uk Kim struct ata_chip_id *idx; 78213014ca0SSøren Schmidt device_t *children; 78313014ca0SSøren Schmidt int nchildren, i; 7847267edacSJung-uk Kim uint8_t s; 78513014ca0SSøren Schmidt 78613014ca0SSøren Schmidt if (device_get_children(device_get_parent(dev), &children, &nchildren)) 7877267edacSJung-uk Kim return (NULL); 78813014ca0SSøren Schmidt 78913014ca0SSøren Schmidt for (i = 0; i < nchildren; i++) { 7907267edacSJung-uk Kim s = pci_get_slot(children[i]); 7917267edacSJung-uk Kim if ((slot >= 0 && s == slot) || (slot < 0 && s <= -slot)) { 7927267edacSJung-uk Kim idx = ata_match_chip(children[i], index); 7937267edacSJung-uk Kim if (idx != NULL) { 79413014ca0SSøren Schmidt free(children, M_TEMP); 7957267edacSJung-uk Kim return (idx); 79613014ca0SSøren Schmidt } 79713014ca0SSøren Schmidt } 79813014ca0SSøren Schmidt } 79913014ca0SSøren Schmidt free(children, M_TEMP); 8007267edacSJung-uk Kim return (NULL); 80113014ca0SSøren Schmidt } 80213014ca0SSøren Schmidt 80313014ca0SSøren Schmidt void 80413014ca0SSøren Schmidt ata_print_cable(device_t dev, u_int8_t *who) 80513014ca0SSøren Schmidt { 80613014ca0SSøren Schmidt device_printf(dev, 80713014ca0SSøren Schmidt "DMA limited to UDMA33, %s found non-ATA66 cable\n", who); 80813014ca0SSøren Schmidt } 80913014ca0SSøren Schmidt 81013014ca0SSøren Schmidt int 81113014ca0SSøren Schmidt ata_check_80pin(device_t dev, int mode) 81213014ca0SSøren Schmidt { 81313014ca0SSøren Schmidt struct ata_device *atadev = device_get_softc(dev); 81413014ca0SSøren Schmidt 81513014ca0SSøren Schmidt if (!ata_dma_check_80pin) { 81613014ca0SSøren Schmidt if (bootverbose) 81713014ca0SSøren Schmidt device_printf(dev, "Skipping 80pin cable check\n"); 81813014ca0SSøren Schmidt return mode; 81913014ca0SSøren Schmidt } 82013014ca0SSøren Schmidt 82113014ca0SSøren Schmidt if (mode > ATA_UDMA2 && !(atadev->param.hwres & ATA_CABLE_ID)) { 82213014ca0SSøren Schmidt ata_print_cable(dev, "device"); 82313014ca0SSøren Schmidt mode = ATA_UDMA2; 82413014ca0SSøren Schmidt } 82513014ca0SSøren Schmidt return mode; 82613014ca0SSøren Schmidt } 82713014ca0SSøren Schmidt 82813014ca0SSøren Schmidt char * 82913014ca0SSøren Schmidt ata_pcivendor2str(device_t dev) 83013014ca0SSøren Schmidt { 83113014ca0SSøren Schmidt switch (pci_get_vendor(dev)) { 83213014ca0SSøren Schmidt case ATA_ACARD_ID: return "Acard"; 83313014ca0SSøren Schmidt case ATA_ACER_LABS_ID: return "AcerLabs"; 83413014ca0SSøren Schmidt case ATA_AMD_ID: return "AMD"; 83513014ca0SSøren Schmidt case ATA_ADAPTEC_ID: return "Adaptec"; 83613014ca0SSøren Schmidt case ATA_ATI_ID: return "ATI"; 83713014ca0SSøren Schmidt case ATA_CYRIX_ID: return "Cyrix"; 83813014ca0SSøren Schmidt case ATA_CYPRESS_ID: return "Cypress"; 83913014ca0SSøren Schmidt case ATA_HIGHPOINT_ID: return "HighPoint"; 84013014ca0SSøren Schmidt case ATA_INTEL_ID: return "Intel"; 84113014ca0SSøren Schmidt case ATA_ITE_ID: return "ITE"; 84213014ca0SSøren Schmidt case ATA_JMICRON_ID: return "JMicron"; 84313014ca0SSøren Schmidt case ATA_MARVELL_ID: return "Marvell"; 84413014ca0SSøren Schmidt case ATA_NATIONAL_ID: return "National"; 84513014ca0SSøren Schmidt case ATA_NETCELL_ID: return "Netcell"; 84613014ca0SSøren Schmidt case ATA_NVIDIA_ID: return "nVidia"; 84713014ca0SSøren Schmidt case ATA_PROMISE_ID: return "Promise"; 84813014ca0SSøren Schmidt case ATA_SERVERWORKS_ID: return "ServerWorks"; 84913014ca0SSøren Schmidt case ATA_SILICON_IMAGE_ID: return "SiI"; 85013014ca0SSøren Schmidt case ATA_SIS_ID: return "SiS"; 85113014ca0SSøren Schmidt case ATA_VIA_ID: return "VIA"; 85213014ca0SSøren Schmidt case ATA_CENATEK_ID: return "Cenatek"; 85313014ca0SSøren Schmidt case ATA_MICRON_ID: return "Micron"; 85413014ca0SSøren Schmidt default: return "Generic"; 85513014ca0SSøren Schmidt } 85613014ca0SSøren Schmidt } 85713014ca0SSøren Schmidt 85813014ca0SSøren Schmidt int 85913014ca0SSøren Schmidt ata_mode2idx(int mode) 86013014ca0SSøren Schmidt { 86113014ca0SSøren Schmidt if ((mode & ATA_DMA_MASK) == ATA_UDMA0) 86213014ca0SSøren Schmidt return (mode & ATA_MODE_MASK) + 8; 86313014ca0SSøren Schmidt if ((mode & ATA_DMA_MASK) == ATA_WDMA0) 86413014ca0SSøren Schmidt return (mode & ATA_MODE_MASK) + 5; 86513014ca0SSøren Schmidt return (mode & ATA_MODE_MASK) - ATA_PIO0; 86613014ca0SSøren Schmidt } 86713014ca0SSøren Schmidt 868