1 /*- 2 * Copyright (c) 1998 - 2008 S�ren Schmidt <sos@FreeBSD.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer, 10 * without modification, immediately at the beginning of the file. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 */ 26 27 #include <sys/cdefs.h> 28 __FBSDID("$FreeBSD$"); 29 30 #include "opt_ata.h" 31 #include <sys/param.h> 32 #include <sys/systm.h> 33 #include <sys/kernel.h> 34 #include <sys/module.h> 35 #include <sys/ata.h> 36 #include <sys/bus.h> 37 #include <sys/conf.h> 38 #include <sys/malloc.h> 39 #include <sys/sema.h> 40 #include <sys/taskqueue.h> 41 #include <vm/uma.h> 42 #include <machine/stdarg.h> 43 #include <machine/resource.h> 44 #include <machine/bus.h> 45 #include <sys/rman.h> 46 #include <dev/pci/pcivar.h> 47 #include <dev/pci/pcireg.h> 48 #include <dev/ata/ata-all.h> 49 #include <dev/ata/ata-pci.h> 50 #include <ata_if.h> 51 52 /* local vars */ 53 static MALLOC_DEFINE(M_ATAPCI, "ata_pci", "ATA driver PCI"); 54 55 /* misc defines */ 56 #define IOMASK 0xfffffffc 57 #define ATA_PROBE_OK -10 58 59 int 60 ata_legacy(device_t dev) 61 { 62 return (((pci_read_config(dev, PCIR_PROGIF, 1)&PCIP_STORAGE_IDE_MASTERDEV)&& 63 ((pci_read_config(dev, PCIR_PROGIF, 1) & 64 (PCIP_STORAGE_IDE_MODEPRIM | PCIP_STORAGE_IDE_MODESEC)) != 65 (PCIP_STORAGE_IDE_MODEPRIM | PCIP_STORAGE_IDE_MODESEC))) || 66 (!pci_read_config(dev, PCIR_BAR(0), 4) && 67 !pci_read_config(dev, PCIR_BAR(1), 4) && 68 !pci_read_config(dev, PCIR_BAR(2), 4) && 69 !pci_read_config(dev, PCIR_BAR(3), 4) && 70 !pci_read_config(dev, PCIR_BAR(5), 4))); 71 } 72 73 int 74 ata_pci_probe(device_t dev) 75 { 76 if (pci_get_class(dev) != PCIC_STORAGE) 77 return ENXIO; 78 79 /* if this is an AHCI chipset grab it */ 80 if (pci_get_subclass(dev) == PCIS_STORAGE_SATA) { 81 if (!ata_ahci_ident(dev)) 82 return ATA_PROBE_OK; 83 } 84 85 /* run through the vendor specific drivers */ 86 switch (pci_get_vendor(dev)) { 87 case ATA_ACARD_ID: 88 if (!ata_acard_ident(dev)) 89 return ATA_PROBE_OK; 90 break; 91 case ATA_ACER_LABS_ID: 92 if (!ata_ali_ident(dev)) 93 return ATA_PROBE_OK; 94 break; 95 case ATA_AMD_ID: 96 if (!ata_amd_ident(dev)) 97 return ATA_PROBE_OK; 98 break; 99 case ATA_ADAPTEC_ID: 100 if (!ata_adaptec_ident(dev)) 101 return ATA_PROBE_OK; 102 break; 103 case ATA_ATI_ID: 104 if (!ata_ati_ident(dev)) 105 return ATA_PROBE_OK; 106 break; 107 case ATA_CYRIX_ID: 108 if (!ata_cyrix_ident(dev)) 109 return ATA_PROBE_OK; 110 break; 111 case ATA_CYPRESS_ID: 112 if (!ata_cypress_ident(dev)) 113 return ATA_PROBE_OK; 114 break; 115 case ATA_HIGHPOINT_ID: 116 if (!ata_highpoint_ident(dev)) 117 return ATA_PROBE_OK; 118 break; 119 case ATA_INTEL_ID: 120 if (!ata_intel_ident(dev)) 121 return ATA_PROBE_OK; 122 break; 123 case ATA_ITE_ID: 124 if (!ata_ite_ident(dev)) 125 return ATA_PROBE_OK; 126 break; 127 case ATA_JMICRON_ID: 128 if (!ata_jmicron_ident(dev)) 129 return ATA_PROBE_OK; 130 break; 131 case ATA_MARVELL_ID: 132 if (!ata_marvell_ident(dev)) 133 return ATA_PROBE_OK; 134 break; 135 case ATA_NATIONAL_ID: 136 if (!ata_national_ident(dev)) 137 return ATA_PROBE_OK; 138 break; 139 case ATA_NETCELL_ID: 140 if (!ata_netcell_ident(dev)) 141 return ATA_PROBE_OK; 142 break; 143 case ATA_NVIDIA_ID: 144 if (!ata_nvidia_ident(dev)) 145 return ATA_PROBE_OK; 146 break; 147 case ATA_PROMISE_ID: 148 if (!ata_promise_ident(dev)) 149 return ATA_PROBE_OK; 150 break; 151 case ATA_SERVERWORKS_ID: 152 if (!ata_serverworks_ident(dev)) 153 return ATA_PROBE_OK; 154 break; 155 case ATA_SILICON_IMAGE_ID: 156 if (!ata_sii_ident(dev)) 157 return ATA_PROBE_OK; 158 break; 159 case ATA_SIS_ID: 160 if (!ata_sis_ident(dev)) 161 return ATA_PROBE_OK; 162 break; 163 case ATA_VIA_ID: 164 if (!ata_via_ident(dev)) 165 return ATA_PROBE_OK; 166 break; 167 case ATA_CENATEK_ID: 168 if (pci_get_devid(dev) == ATA_CENATEK_ROCKET) { 169 ata_generic_ident(dev); 170 device_set_desc(dev, "Cenatek Rocket Drive controller"); 171 return ATA_PROBE_OK; 172 } 173 break; 174 case ATA_MICRON_ID: 175 if (pci_get_devid(dev) == ATA_MICRON_RZ1000 || 176 pci_get_devid(dev) == ATA_MICRON_RZ1001) { 177 ata_generic_ident(dev); 178 device_set_desc(dev, 179 "RZ 100? ATA controller !WARNING! data loss/corruption risk"); 180 return ATA_PROBE_OK; 181 } 182 break; 183 } 184 185 /* unknown chipset, try generic DMA if it seems possible */ 186 if (pci_get_subclass(dev) == PCIS_STORAGE_IDE) { 187 if (!ata_generic_ident(dev)) 188 return ATA_PROBE_OK; 189 } 190 return ENXIO; 191 } 192 193 int 194 ata_pci_attach(device_t dev) 195 { 196 struct ata_pci_controller *ctlr = device_get_softc(dev); 197 u_int32_t cmd; 198 int unit; 199 200 /* do chipset specific setups only needed once */ 201 if (ata_legacy(dev) || pci_read_config(dev, PCIR_BAR(2), 4) & IOMASK) 202 ctlr->channels = 2; 203 else 204 ctlr->channels = 1; 205 ctlr->allocate = ata_pci_allocate; 206 ctlr->dmainit = ata_pci_dmainit; 207 ctlr->dev = dev; 208 209 /* if needed try to enable busmastering */ 210 cmd = pci_read_config(dev, PCIR_COMMAND, 2); 211 if (!(cmd & PCIM_CMD_BUSMASTEREN)) { 212 pci_write_config(dev, PCIR_COMMAND, cmd | PCIM_CMD_BUSMASTEREN, 2); 213 cmd = pci_read_config(dev, PCIR_COMMAND, 2); 214 } 215 216 /* if busmastering mode "stuck" use it */ 217 if ((cmd & PCIM_CMD_BUSMASTEREN) == PCIM_CMD_BUSMASTEREN) { 218 ctlr->r_type1 = SYS_RES_IOPORT; 219 ctlr->r_rid1 = ATA_BMADDR_RID; 220 ctlr->r_res1 = bus_alloc_resource_any(dev, ctlr->r_type1, &ctlr->r_rid1, 221 RF_ACTIVE); 222 } 223 224 if (ctlr->chipinit(dev)) 225 return ENXIO; 226 227 /* attach all channels on this controller */ 228 for (unit = 0; unit < ctlr->channels; unit++) { 229 if ((unit == 0 || unit == 1) && ata_legacy(dev)) { 230 device_add_child(dev, "ata", unit); 231 continue; 232 } 233 device_add_child(dev, "ata", devclass_find_free_unit(ata_devclass, 2)); 234 } 235 bus_generic_attach(dev); 236 return 0; 237 } 238 239 int 240 ata_pci_detach(device_t dev) 241 { 242 struct ata_pci_controller *ctlr = device_get_softc(dev); 243 device_t *children; 244 int nchildren, i; 245 246 /* detach & delete all children */ 247 if (!device_get_children(dev, &children, &nchildren)) { 248 for (i = 0; i < nchildren; i++) 249 device_delete_child(dev, children[i]); 250 free(children, M_TEMP); 251 } 252 253 if (ctlr->r_irq) { 254 bus_teardown_intr(dev, ctlr->r_irq, ctlr->handle); 255 bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ctlr->r_irq); 256 } 257 if (ctlr->r_res2) 258 bus_release_resource(dev, ctlr->r_type2, ctlr->r_rid2, ctlr->r_res2); 259 if (ctlr->r_res1) 260 bus_release_resource(dev, ctlr->r_type1, ctlr->r_rid1, ctlr->r_res1); 261 262 return 0; 263 } 264 265 struct resource * 266 ata_pci_alloc_resource(device_t dev, device_t child, int type, int *rid, 267 u_long start, u_long end, u_long count, u_int flags) 268 { 269 struct ata_pci_controller *controller = device_get_softc(dev); 270 int unit = ((struct ata_channel *)device_get_softc(child))->unit; 271 struct resource *res = NULL; 272 int myrid; 273 274 if (type == SYS_RES_IOPORT) { 275 switch (*rid) { 276 case ATA_IOADDR_RID: 277 if (ata_legacy(dev)) { 278 start = (unit ? ATA_SECONDARY : ATA_PRIMARY); 279 count = ATA_IOSIZE; 280 end = start + count - 1; 281 } 282 myrid = PCIR_BAR(0) + (unit << 3); 283 res = BUS_ALLOC_RESOURCE(device_get_parent(dev), dev, 284 SYS_RES_IOPORT, &myrid, 285 start, end, count, flags); 286 break; 287 288 case ATA_CTLADDR_RID: 289 if (ata_legacy(dev)) { 290 start = (unit ? ATA_SECONDARY : ATA_PRIMARY) + ATA_CTLOFFSET; 291 count = ATA_CTLIOSIZE; 292 end = start + count - 1; 293 } 294 myrid = PCIR_BAR(1) + (unit << 3); 295 res = BUS_ALLOC_RESOURCE(device_get_parent(dev), dev, 296 SYS_RES_IOPORT, &myrid, 297 start, end, count, flags); 298 break; 299 } 300 } 301 if (type == SYS_RES_IRQ && *rid == ATA_IRQ_RID) { 302 if (ata_legacy(dev)) { 303 int irq = (unit == 0 ? 14 : 15); 304 305 res = BUS_ALLOC_RESOURCE(device_get_parent(dev), child, 306 SYS_RES_IRQ, rid, irq, irq, 1, flags); 307 } 308 else 309 res = controller->r_irq; 310 } 311 return res; 312 } 313 314 int 315 ata_pci_release_resource(device_t dev, device_t child, int type, int rid, 316 struct resource *r) 317 { 318 int unit = ((struct ata_channel *)device_get_softc(child))->unit; 319 320 if (type == SYS_RES_IOPORT) { 321 switch (rid) { 322 case ATA_IOADDR_RID: 323 return BUS_RELEASE_RESOURCE(device_get_parent(dev), dev, 324 SYS_RES_IOPORT, 325 PCIR_BAR(0) + (unit << 3), r); 326 break; 327 328 case ATA_CTLADDR_RID: 329 return BUS_RELEASE_RESOURCE(device_get_parent(dev), dev, 330 SYS_RES_IOPORT, 331 PCIR_BAR(1) + (unit << 3), r); 332 break; 333 default: 334 return ENOENT; 335 } 336 } 337 if (type == SYS_RES_IRQ) { 338 if (rid != ATA_IRQ_RID) 339 return ENOENT; 340 341 if (ata_legacy(dev)) { 342 return BUS_RELEASE_RESOURCE(device_get_parent(dev), child, 343 SYS_RES_IRQ, rid, r); 344 } 345 else 346 return 0; 347 } 348 return EINVAL; 349 } 350 351 int 352 ata_pci_setup_intr(device_t dev, device_t child, struct resource *irq, 353 int flags, driver_filter_t *filter, driver_intr_t *function, 354 void *argument, void **cookiep) 355 { 356 if (ata_legacy(dev)) { 357 return BUS_SETUP_INTR(device_get_parent(dev), child, irq, 358 flags, filter, function, argument, cookiep); 359 } 360 else { 361 struct ata_pci_controller *controller = device_get_softc(dev); 362 int unit = ((struct ata_channel *)device_get_softc(child))->unit; 363 364 if (filter != NULL) { 365 printf("ata-pci.c: we cannot use a filter here\n"); 366 return (EINVAL); 367 } 368 controller->interrupt[unit].function = function; 369 controller->interrupt[unit].argument = argument; 370 *cookiep = controller; 371 return 0; 372 } 373 } 374 375 int 376 ata_pci_teardown_intr(device_t dev, device_t child, struct resource *irq, 377 void *cookie) 378 { 379 if (ata_legacy(dev)) { 380 return BUS_TEARDOWN_INTR(device_get_parent(dev), child, irq, cookie); 381 } 382 else { 383 struct ata_pci_controller *controller = device_get_softc(dev); 384 int unit = ((struct ata_channel *)device_get_softc(child))->unit; 385 386 controller->interrupt[unit].function = NULL; 387 controller->interrupt[unit].argument = NULL; 388 return 0; 389 } 390 } 391 392 int 393 ata_pci_allocate(device_t dev) 394 { 395 struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 396 struct ata_channel *ch = device_get_softc(dev); 397 struct resource *io = NULL, *ctlio = NULL; 398 int i, rid; 399 400 rid = ATA_IOADDR_RID; 401 if (!(io = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE))) 402 return ENXIO; 403 404 rid = ATA_CTLADDR_RID; 405 if (!(ctlio = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid,RF_ACTIVE))){ 406 bus_release_resource(dev, SYS_RES_IOPORT, ATA_IOADDR_RID, io); 407 return ENXIO; 408 } 409 410 for (i = ATA_DATA; i <= ATA_COMMAND; i ++) { 411 ch->r_io[i].res = io; 412 ch->r_io[i].offset = i; 413 } 414 ch->r_io[ATA_CONTROL].res = ctlio; 415 ch->r_io[ATA_CONTROL].offset = ata_legacy(device_get_parent(dev)) ? 0 : 2; 416 ch->r_io[ATA_IDX_ADDR].res = io; 417 ata_default_registers(dev); 418 if (ctlr->r_res1) { 419 for (i = ATA_BMCMD_PORT; i <= ATA_BMDTP_PORT; i++) { 420 ch->r_io[i].res = ctlr->r_res1; 421 ch->r_io[i].offset = (i - ATA_BMCMD_PORT) + (ch->unit*ATA_BMIOSIZE); 422 } 423 } 424 425 ata_pci_hw(dev); 426 return 0; 427 } 428 429 int 430 ata_pci_status(device_t dev) 431 { 432 struct ata_channel *ch = device_get_softc(dev); 433 434 if ((dumping || !ata_legacy(device_get_parent(dev))) && 435 ((ch->flags & ATA_ALWAYS_DMASTAT) || 436 (ch->dma.flags & ATA_DMA_ACTIVE))) { 437 int bmstat = ATA_IDX_INB(ch, ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK; 438 439 if ((bmstat & (ATA_BMSTAT_ACTIVE | ATA_BMSTAT_INTERRUPT)) != 440 ATA_BMSTAT_INTERRUPT) 441 return 0; 442 ATA_IDX_OUTB(ch, ATA_BMSTAT_PORT, bmstat & ~ATA_BMSTAT_ERROR); 443 DELAY(1); 444 } 445 if (ATA_IDX_INB(ch, ATA_ALTSTAT) & ATA_S_BUSY) { 446 DELAY(100); 447 if (ATA_IDX_INB(ch, ATA_ALTSTAT) & ATA_S_BUSY) 448 return 0; 449 } 450 return 1; 451 } 452 453 void 454 ata_pci_hw(device_t dev) 455 { 456 struct ata_channel *ch = device_get_softc(dev); 457 458 ata_generic_hw(dev); 459 ch->hw.status = ata_pci_status; 460 } 461 462 static int 463 ata_pci_dmastart(struct ata_request *request) 464 { 465 struct ata_channel *ch = device_get_softc(request->parent); 466 467 ATA_DEBUG_RQ(request, "dmastart"); 468 469 ATA_IDX_OUTB(ch, ATA_BMSTAT_PORT, (ATA_IDX_INB(ch, ATA_BMSTAT_PORT) | 470 (ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR))); 471 ATA_IDX_OUTL(ch, ATA_BMDTP_PORT, request->dma->sg_bus); 472 ch->dma.flags |= ATA_DMA_ACTIVE; 473 ATA_IDX_OUTB(ch, ATA_BMCMD_PORT, 474 (ATA_IDX_INB(ch, ATA_BMCMD_PORT) & ~ATA_BMCMD_WRITE_READ) | 475 ((request->flags & ATA_R_READ) ? ATA_BMCMD_WRITE_READ : 0)| 476 ATA_BMCMD_START_STOP); 477 return 0; 478 } 479 480 static int 481 ata_pci_dmastop(struct ata_request *request) 482 { 483 struct ata_channel *ch = device_get_softc(request->parent); 484 int error; 485 486 ATA_DEBUG_RQ(request, "dmastop"); 487 488 ATA_IDX_OUTB(ch, ATA_BMCMD_PORT, 489 ATA_IDX_INB(ch, ATA_BMCMD_PORT) & ~ATA_BMCMD_START_STOP); 490 ch->dma.flags &= ~ATA_DMA_ACTIVE; 491 error = ATA_IDX_INB(ch, ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK; 492 ATA_IDX_OUTB(ch, ATA_BMSTAT_PORT, ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR); 493 return error; 494 } 495 496 static void 497 ata_pci_dmareset(device_t dev) 498 { 499 struct ata_channel *ch = device_get_softc(dev); 500 struct ata_request *request; 501 502 ATA_IDX_OUTB(ch, ATA_BMCMD_PORT, 503 ATA_IDX_INB(ch, ATA_BMCMD_PORT) & ~ATA_BMCMD_START_STOP); 504 ch->dma.flags &= ~ATA_DMA_ACTIVE; 505 ATA_IDX_OUTB(ch, ATA_BMSTAT_PORT, ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR); 506 if ((request = ch->running)) { 507 device_printf(request->dev, "DMA reset calling unload\n"); 508 ch->dma.unload(request); 509 } 510 } 511 512 void 513 ata_pci_dmainit(device_t dev) 514 { 515 struct ata_channel *ch = device_get_softc(dev); 516 517 ata_dmainit(dev); 518 ch->dma.start = ata_pci_dmastart; 519 ch->dma.stop = ata_pci_dmastop; 520 ch->dma.reset = ata_pci_dmareset; 521 } 522 523 char * 524 ata_pcivendor2str(device_t dev) 525 { 526 switch (pci_get_vendor(dev)) { 527 case ATA_ACARD_ID: return "Acard"; 528 case ATA_ACER_LABS_ID: return "AcerLabs"; 529 case ATA_AMD_ID: return "AMD"; 530 case ATA_ADAPTEC_ID: return "Adaptec"; 531 case ATA_ATI_ID: return "ATI"; 532 case ATA_CYRIX_ID: return "Cyrix"; 533 case ATA_CYPRESS_ID: return "Cypress"; 534 case ATA_HIGHPOINT_ID: return "HighPoint"; 535 case ATA_INTEL_ID: return "Intel"; 536 case ATA_ITE_ID: return "ITE"; 537 case ATA_JMICRON_ID: return "JMicron"; 538 case ATA_MARVELL_ID: return "Marvell"; 539 case ATA_NATIONAL_ID: return "National"; 540 case ATA_NETCELL_ID: return "Netcell"; 541 case ATA_NVIDIA_ID: return "nVidia"; 542 case ATA_PROMISE_ID: return "Promise"; 543 case ATA_SERVERWORKS_ID: return "ServerWorks"; 544 case ATA_SILICON_IMAGE_ID: return "SiI"; 545 case ATA_SIS_ID: return "SiS"; 546 case ATA_VIA_ID: return "VIA"; 547 case ATA_CENATEK_ID: return "Cenatek"; 548 case ATA_MICRON_ID: return "Micron"; 549 default: return "Generic"; 550 } 551 } 552 553 static device_method_t ata_pci_methods[] = { 554 /* device interface */ 555 DEVMETHOD(device_probe, ata_pci_probe), 556 DEVMETHOD(device_attach, ata_pci_attach), 557 DEVMETHOD(device_detach, ata_pci_detach), 558 DEVMETHOD(device_shutdown, bus_generic_shutdown), 559 DEVMETHOD(device_suspend, bus_generic_suspend), 560 DEVMETHOD(device_resume, bus_generic_resume), 561 562 /* bus methods */ 563 DEVMETHOD(bus_alloc_resource, ata_pci_alloc_resource), 564 DEVMETHOD(bus_release_resource, ata_pci_release_resource), 565 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 566 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 567 DEVMETHOD(bus_setup_intr, ata_pci_setup_intr), 568 DEVMETHOD(bus_teardown_intr, ata_pci_teardown_intr), 569 570 { 0, 0 } 571 }; 572 573 devclass_t atapci_devclass; 574 575 static driver_t ata_pci_driver = { 576 "atapci", 577 ata_pci_methods, 578 sizeof(struct ata_pci_controller), 579 }; 580 581 DRIVER_MODULE(atapci, pci, ata_pci_driver, atapci_devclass, 0, 0); 582 MODULE_VERSION(atapci, 1); 583 MODULE_DEPEND(atapci, ata, 1, 1, 1); 584 585 static int 586 ata_pcichannel_probe(device_t dev) 587 { 588 struct ata_channel *ch = device_get_softc(dev); 589 device_t *children; 590 int count, i; 591 char buffer[32]; 592 593 /* take care of green memory */ 594 bzero(ch, sizeof(struct ata_channel)); 595 596 /* find channel number on this controller */ 597 device_get_children(device_get_parent(dev), &children, &count); 598 for (i = 0; i < count; i++) { 599 if (children[i] == dev) 600 ch->unit = i; 601 } 602 free(children, M_TEMP); 603 604 sprintf(buffer, "ATA channel %d", ch->unit); 605 device_set_desc_copy(dev, buffer); 606 607 return ata_probe(dev); 608 } 609 610 static int 611 ata_pcichannel_attach(device_t dev) 612 { 613 struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 614 struct ata_channel *ch = device_get_softc(dev); 615 int error; 616 617 if (ctlr->dmainit) 618 ctlr->dmainit(dev); 619 620 if ((error = ctlr->allocate(dev))) 621 return error; 622 623 if ((error = ata_attach(dev))) 624 return error; 625 626 ch->dma.alloc(dev); 627 return 0; 628 } 629 630 static int 631 ata_pcichannel_detach(device_t dev) 632 { 633 struct ata_channel *ch = device_get_softc(dev); 634 int error; 635 636 if ((error = ata_detach(dev))) 637 return error; 638 639 ch->dma.free(dev); 640 641 /* XXX SOS free resources for io and ctlio ?? */ 642 643 return 0; 644 } 645 646 static int 647 ata_pcichannel_locking(device_t dev, int mode) 648 { 649 struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 650 struct ata_channel *ch = device_get_softc(dev); 651 652 if (ctlr->locking) 653 return ctlr->locking(dev, mode); 654 else 655 return ch->unit; 656 } 657 658 static void 659 ata_pcichannel_reset(device_t dev) 660 { 661 struct ata_pci_controller *ctlr = device_get_softc(device_get_parent(dev)); 662 struct ata_channel *ch = device_get_softc(dev); 663 664 /* if DMA engine present reset it */ 665 if (ch->dma.reset) 666 ch->dma.reset(dev); 667 668 /* reset the controller HW */ 669 if (ctlr->reset) 670 ctlr->reset(dev); 671 else 672 ata_generic_reset(dev); 673 } 674 675 static void 676 ata_pcichannel_setmode(device_t parent, device_t dev) 677 { 678 struct ata_pci_controller *ctlr = device_get_softc(GRANDPARENT(dev)); 679 struct ata_device *atadev = device_get_softc(dev); 680 int mode = atadev->mode; 681 682 ctlr->setmode(dev, ATA_PIO_MAX); 683 if (mode >= ATA_DMA) 684 ctlr->setmode(dev, mode); 685 } 686 687 static device_method_t ata_pcichannel_methods[] = { 688 /* device interface */ 689 DEVMETHOD(device_probe, ata_pcichannel_probe), 690 DEVMETHOD(device_attach, ata_pcichannel_attach), 691 DEVMETHOD(device_detach, ata_pcichannel_detach), 692 DEVMETHOD(device_shutdown, bus_generic_shutdown), 693 DEVMETHOD(device_suspend, ata_suspend), 694 DEVMETHOD(device_resume, ata_resume), 695 696 /* ATA methods */ 697 DEVMETHOD(ata_setmode, ata_pcichannel_setmode), 698 DEVMETHOD(ata_locking, ata_pcichannel_locking), 699 DEVMETHOD(ata_reset, ata_pcichannel_reset), 700 701 { 0, 0 } 702 }; 703 704 driver_t ata_pcichannel_driver = { 705 "ata", 706 ata_pcichannel_methods, 707 sizeof(struct ata_channel), 708 }; 709 710 DRIVER_MODULE(ata, atapci, ata_pcichannel_driver, ata_devclass, 0, 0); 711