220 case 0x248a8086: /* Intel ICH3 mobile */ 221 case 0x248b8086: /* Intel ICH3 */ 222 case 0x244a8086: /* Intel ICH2 mobile */ 223 case 0x244b8086: /* Intel ICH2 */ 224 if (udmamode >= 5) { 225 int32_t mask48, new48; 226 int16_t word54; 227 228 word54 = pci_read_config(parent, 0x54, 2); 229 if (word54 & (0x10 << devno)) { 230 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 231 ATA_UDMA5, ATA_C_F_SETXFER,ATA_WAIT_READY); 232 if (bootverbose) 233 ata_prtdev(atadev, "%s setting UDMA5 on Intel chip\n", 234 (error) ? "failed" : "success"); 235 if (!error) { 236 mask48 = (1 << devno) + (3 << (16 + (devno << 2))); 237 new48 = (1 << devno) + (1 << (16 + (devno << 2))); 238 pci_write_config(parent, 0x48, 239 (pci_read_config(parent, 0x48, 4) & 240 ~mask48) | new48, 4); 241 pci_write_config(parent, 0x54, word54 | (0x1000<<devno), 2); 242 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 243 return; 244 } 245 } 246 } 247 /* make sure eventual ATA100 mode from the BIOS is disabled */ 248 pci_write_config(parent, 0x54, 249 pci_read_config(parent, 0x54, 2) & ~(0x1000<<devno),2); 250 /* FALLTHROUGH */ 251 252 case 0x24118086: /* Intel ICH */ 253 case 0x76018086: /* Intel ICH */ 254 if (udmamode >= 4) { 255 int32_t mask48, new48; 256 int16_t word54; 257 258 word54 = pci_read_config(parent, 0x54, 2); 259 if (word54 & (0x10 << devno)) { 260 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 261 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 262 if (bootverbose) 263 ata_prtdev(atadev, "%s setting UDMA4 on Intel chip\n", 264 (error) ? "failed" : "success"); 265 if (!error) { 266 mask48 = (1 << devno) + (3 << (16 + (devno << 2))); 267 new48 = (1 << devno) + (2 << (16 + (devno << 2))); 268 pci_write_config(parent, 0x48, 269 (pci_read_config(parent, 0x48, 4) & 270 ~mask48) | new48, 4); 271 pci_write_config(parent, 0x54, word54 | (1 << devno), 2); 272 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 273 return; 274 } 275 } 276 } 277 /* make sure eventual ATA66 mode from the BIOS is disabled */ 278 pci_write_config(parent, 0x54, 279 pci_read_config(parent, 0x54, 2) & ~(1 << devno), 2); 280 /* FALLTHROUGH */ 281 282 case 0x71118086: /* Intel PIIX4 */ 283 case 0x84CA8086: /* Intel PIIX4 */ 284 case 0x71998086: /* Intel PIIX4e */ 285 case 0x24218086: /* Intel ICH0 */ 286 if (udmamode >= 2) { 287 int32_t mask48, new48; 288 289 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 290 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 291 if (bootverbose) 292 ata_prtdev(atadev, "%s setting UDMA2 on Intel chip\n", 293 (error) ? "failed" : "success"); 294 if (!error) { 295 mask48 = (1 << devno) + (3 << (16 + (devno << 2))); 296 new48 = (1 << devno) + (2 << (16 + (devno << 2))); 297 pci_write_config(parent, 0x48, 298 (pci_read_config(parent, 0x48, 4) & 299 ~mask48) | new48, 4); 300 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 301 return; 302 } 303 } 304 /* make sure eventual ATA33 mode from the BIOS is disabled */ 305 pci_write_config(parent, 0x48, 306 pci_read_config(parent, 0x48, 4) & ~(1 << devno), 4); 307 /* FALLTHROUGH */ 308 309 case 0x70108086: /* Intel PIIX3 */ 310 if (wdmamode >= 2 && apiomode >= 4) { 311 int32_t mask40, new40, mask44, new44; 312 313 /* if SITRE not set doit for both channels */ 314 if (!((pci_read_config(parent, 0x40, 4) >> (channel<<8)) & 0x4000)){ 315 new40 = pci_read_config(parent, 0x40, 4); 316 new44 = pci_read_config(parent, 0x44, 4); 317 if (!(new40 & 0x00004000)) { 318 new44 &= ~0x0000000f; 319 new44 |= ((new40&0x00003000)>>10)|((new40&0x00000300)>>8); 320 } 321 if (!(new40 & 0x40000000)) { 322 new44 &= ~0x000000f0; 323 new44 |= ((new40&0x30000000)>>22)|((new40&0x03000000)>>20); 324 } 325 new40 |= 0x40004000; 326 pci_write_config(parent, 0x40, new40, 4); 327 pci_write_config(parent, 0x44, new44, 4); 328 } 329 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 330 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 331 if (bootverbose) 332 ata_prtdev(atadev, "%s setting WDMA2 on Intel chip\n", 333 (error) ? "failed" : "success"); 334 if (!error) { 335 if (device == ATA_MASTER) { 336 mask40 = 0x0000330f; 337 new40 = 0x00002307; 338 mask44 = 0; 339 new44 = 0; 340 } 341 else { 342 mask40 = 0x000000f0; 343 new40 = 0x00000070; 344 mask44 = 0x0000000f; 345 new44 = 0x0000000b; 346 } 347 if (channel) { 348 mask40 <<= 16; 349 new40 <<= 16; 350 mask44 <<= 4; 351 new44 <<= 4; 352 } 353 pci_write_config(parent, 0x40, 354 (pci_read_config(parent, 0x40, 4) & ~mask40)| 355 new40, 4); 356 pci_write_config(parent, 0x44, 357 (pci_read_config(parent, 0x44, 4) & ~mask44)| 358 new44, 4); 359 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 360 return; 361 } 362 } 363 /* we could set PIO mode timings, but we assume the BIOS did that */ 364 break; 365 366 case 0x12308086: /* Intel PIIX */ 367 if (wdmamode >= 2 && apiomode >= 4) { 368 int32_t word40; 369 370 word40 = pci_read_config(parent, 0x40, 4); 371 word40 >>= channel * 16; 372 373 /* Check for timing config usable for DMA on controller */ 374 if (!((word40 & 0x3300) == 0x2300 && 375 ((word40 >> (device ? 4 : 0)) & 1) == 1)) 376 break; 377 378 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 379 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 380 if (bootverbose) 381 ata_prtdev(atadev, "%s setting WDMA2 on Intel chip\n", 382 (error) ? "failed" : "success"); 383 if (!error) { 384 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 385 return; 386 } 387 } 388 break; 389 390 case 0x522910b9: /* AcerLabs Aladdin IV/V */ 391 /* the older Aladdin doesn't support ATAPI DMA on both master & slave */ 392 if (chiprev < 0xc2 && 393 atadev->channel->devices & ATA_ATAPI_MASTER && 394 atadev->channel->devices & ATA_ATAPI_SLAVE) { 395 ata_prtdev(atadev, "two atapi devices on this channel, no DMA\n"); 396 break; 397 } 398 pci_write_config(parent, 0x58 + (channel << 2), 0x00310001, 4); 399 if (udmamode >= 5 && chiprev >= 0xc4) { 400 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 401 ATA_UDMA5, ATA_C_F_SETXFER, ATA_WAIT_READY); 402 if (bootverbose) 403 ata_prtdev(atadev, "%s setting UDMA5 on Acer chip\n", 404 (error) ? "failed" : "success"); 405 if (!error) { 406 int32_t word54 = pci_read_config(parent, 0x54, 4); 407 408 pci_write_config(parent, 0x4b, 409 pci_read_config(parent, 0x4b, 1) | 0x01, 1); 410 word54 &= ~(0x000f000f << (devno << 2)); 411 word54 |= (0x000f0005 << (devno << 2)); 412 pci_write_config(parent, 0x54, word54, 4); 413 pci_write_config(parent, 0x53, 414 pci_read_config(parent, 0x53, 1) | 0x03, 1); 415 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 416 return; 417 } 418 } 419 if (udmamode >= 4 && chiprev >= 0xc2) { 420 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 421 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 422 if (bootverbose) 423 ata_prtdev(atadev, "%s setting UDMA4 on Acer chip\n", 424 (error) ? "failed" : "success"); 425 if (!error) { 426 int32_t word54 = pci_read_config(parent, 0x54, 4); 427 428 pci_write_config(parent, 0x4b, 429 pci_read_config(parent, 0x4b, 1) | 0x01, 1); 430 word54 &= ~(0x000f000f << (devno << 2)); 431 word54 |= (0x00080005 << (devno << 2)); 432 pci_write_config(parent, 0x54, word54, 4); 433 pci_write_config(parent, 0x53, 434 pci_read_config(parent, 0x53, 1) | 0x03, 1); 435 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 436 return; 437 } 438 } 439 if (udmamode >= 2 && chiprev >= 0x20) { 440 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 441 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 442 if (bootverbose) 443 ata_prtdev(atadev, "%s setting UDMA2 on Acer chip\n", 444 (error) ? "failed" : "success"); 445 if (!error) { 446 int32_t word54 = pci_read_config(parent, 0x54, 4); 447 448 word54 &= ~(0x000f000f << (devno << 2)); 449 word54 |= (0x000a0005 << (devno << 2)); 450 pci_write_config(parent, 0x54, word54, 4); 451 pci_write_config(parent, 0x53, 452 pci_read_config(parent, 0x53, 1) | 0x03, 1); 453 atadev->channel->flags |= ATA_ATAPI_DMA_RO; 454 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 455 return; 456 } 457 } 458 459 /* make sure eventual UDMA mode from the BIOS is disabled */ 460 pci_write_config(parent, 0x56, pci_read_config(parent, 0x56, 2) & 461 ~(0x0008 << (devno << 2)), 2); 462 463 if (wdmamode >= 2 && apiomode >= 4) { 464 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 465 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 466 if (bootverbose) 467 ata_prtdev(atadev, "%s setting WDMA2 on Acer chip\n", 468 (error) ? "failed" : "success"); 469 if (!error) { 470 pci_write_config(parent, 0x53, 471 pci_read_config(parent, 0x53, 1) | 0x03, 1); 472 atadev->channel->flags |= ATA_ATAPI_DMA_RO; 473 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 474 return; 475 } 476 } 477 pci_write_config(parent, 0x53, 478 (pci_read_config(parent, 0x53, 1) & ~0x01) | 0x02, 1); 479 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 480 ATA_PIO0 + apiomode, 481 ATA_C_F_SETXFER, ATA_WAIT_READY); 482 if (bootverbose) 483 ata_prtdev(atadev, "%s setting PIO%d on Acer chip\n", 484 (error) ? "failed" : "success", 485 (apiomode >= 0) ? apiomode : 0); 486 if (!error) { 487 int32_t word54 = pci_read_config(parent, 0x54, 4); 488 int32_t timing; 489 490 switch(ATA_PIO0 + apiomode) { 491 case ATA_PIO0: timing = 0x006d0003; 492 case ATA_PIO1: timing = 0x00580002; 493 case ATA_PIO2: timing = 0x00440001; 494 case ATA_PIO3: timing = 0x00330001; 495 case ATA_PIO4: timing = 0x00310001; 496 default: timing = 0x006d0003; 497 } 498 pci_write_config(parent, 0x58 + (channel << 2), timing, 4); 499 word54 &= ~(0x000f000f << (devno << 2)); 500 word54 |= (0x00000004 << (devno << 2)); 501 pci_write_config(parent, 0x54, word54, 4); 502 atadev->mode = ATA_PIO0 + apiomode; 503 return; 504 } 505 break; 506 507 case 0x01bc10de: /* nVIDIA nForce */ 508 case 0x74411022: /* AMD 768 */ 509 case 0x74111022: /* AMD 766 */ 510 case 0x74091022: /* AMD 756 */ 511 case 0x05711106: /* VIA 82C571, 82C586, 82C596, 82C686 , 8231, 8233 */ 512 { 513 int via_modes[5][7] = { 514 { 0x00, 0x00, 0xc0, 0x00, 0x00, 0x00, 0x00 }, /* VIA ATA33 */ 515 { 0x00, 0x00, 0xea, 0x00, 0xe8, 0x00, 0x00 }, /* VIA ATA66 */ 516 { 0x00, 0x00, 0xf4, 0x00, 0xf1, 0xf0, 0x00 }, /* VIA ATA100 */ 517 { 0x00, 0x00, 0xf6, 0x00, 0xf2, 0xf1, 0xf0 }, /* VIA ATA133 */ 518 { 0x00, 0x00, 0xc0, 0x00, 0xc5, 0xc6, 0x00 }}; /* AMD/nVIDIA */ 519 int *reg_val = NULL; 520 char *chip = "VIA"; 521 522 if (ata_find_dev(parent, 0x31471106, 0)) { /* 8233a */ 523 udmamode = imin(udmamode, 6); 524 reg_val = via_modes[3]; 525 } 526 else if (ata_find_dev(parent, 0x06861106, 0x40) || /* 82C686b */ 527 ata_find_dev(parent, 0x82311106, 0) || /* 8231 */ 528 ata_find_dev(parent, 0x30741106, 0) || /* 8233 */ 529 ata_find_dev(parent, 0x31091106, 0)) { /* 8233c */ 530 udmamode = imin(udmamode, 5); 531 reg_val = via_modes[2]; 532 } 533 else if (ata_find_dev(parent, 0x06861106, 0x10) || /* 82C686a */ 534 ata_find_dev(parent, 0x05961106, 0x12)) { /* 82C596b */ 535 udmamode = imin(udmamode, 4); 536 reg_val = via_modes[1]; 537 } 538 else if (ata_find_dev(parent, 0x06861106, 0)) { /* 82C686 */ 539 udmamode = imin(udmamode, 2); 540 reg_val = via_modes[1]; 541 } 542 else if (ata_find_dev(parent, 0x05961106, 0) || /* 82C596a */ 543 ata_find_dev(parent, 0x05861106, 0x03)) { /* 82C586b */ 544 udmamode = imin(udmamode, 2); 545 reg_val = via_modes[0]; 546 } 547 else if (chiptype == 0x74411022 || /* AMD 768 */ 548 chiptype == 0x74111022) { /* AMD 766 */ 549 udmamode = imin(udmamode, 5); 550 reg_val = via_modes[4]; 551 chip = "AMD"; 552 } 553 else if (chiptype == 0x74091022) { /* AMD 756 */ 554 udmamode = imin(udmamode, 4); 555 reg_val = via_modes[4]; 556 chip = "AMD"; 557 } 558 else if (chiptype == 0x01bc10de) { /* nVIDIA */ 559 udmamode = imin(udmamode, 5); 560 reg_val = via_modes[4]; 561 chip = "nVIDIA"; 562 } 563 else 564 udmamode = 0; 565 566 if (udmamode >= 6) { 567 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 568 ATA_UDMA6, ATA_C_F_SETXFER, ATA_WAIT_READY); 569 if (bootverbose) 570 ata_prtdev(atadev, "%s setting UDMA6 on %s chip\n", 571 (error) ? "failed" : "success", chip); 572 if (!error) { 573 pci_write_config(parent, 0x53 - devno, reg_val[6], 1); 574 ata_dmacreate(atadev, apiomode, ATA_UDMA6); 575 return; 576 } 577 } 578 if (udmamode >= 5) { 579 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 580 ATA_UDMA5, ATA_C_F_SETXFER, ATA_WAIT_READY); 581 if (bootverbose) 582 ata_prtdev(atadev, "%s setting UDMA5 on %s chip\n", 583 (error) ? "failed" : "success", chip); 584 if (!error) { 585 pci_write_config(parent, 0x53 - devno, reg_val[5], 1); 586 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 587 return; 588 } 589 } 590 if (udmamode >= 4) { 591 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 592 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 593 if (bootverbose) 594 ata_prtdev(atadev, "%s setting UDMA4 on %s chip\n", 595 (error) ? "failed" : "success", chip); 596 if (!error) { 597 pci_write_config(parent, 0x53 - devno, reg_val[4], 1); 598 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 599 return; 600 } 601 } 602 if (udmamode >= 2) { 603 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 604 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 605 if (bootverbose) 606 ata_prtdev(atadev, "%s setting UDMA2 on %s chip\n", 607 (error) ? "failed" : "success", chip); 608 if (!error) { 609 pci_write_config(parent, 0x53 - devno, reg_val[2], 1); 610 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 611 return; 612 } 613 } 614 if (wdmamode >= 2 && apiomode >= 4) { 615 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 616 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 617 if (bootverbose) 618 ata_prtdev(atadev, "%s setting WDMA2 on %s chip\n", 619 (error) ? "failed" : "success", chip); 620 if (!error) { 621 pci_write_config(parent, 0x53 - devno, 0x0b, 1); 622 pci_write_config(parent, 0x4b - devno, 0x31, 1); 623 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 624 return; 625 } 626 } 627 } 628 /* we could set PIO mode timings, but we assume the BIOS did that */ 629 break; 630 631 case 0x55131039: /* SiS 5591 */ 632 if (ata_find_dev(parent, 0x06301039, 0x30) || /* SiS 630 */ 633 ata_find_dev(parent, 0x06331039, 0) || /* SiS 633 */ 634 ata_find_dev(parent, 0x06351039, 0) || /* SiS 635 */ 635 ata_find_dev(parent, 0x06401039, 0) || /* SiS 640 */ 636 ata_find_dev(parent, 0x06451039, 0) || /* SiS 645 */ 637 ata_find_dev(parent, 0x06501039, 0) || /* SiS 650 */ 638 ata_find_dev(parent, 0x07301039, 0) || /* SiS 730 */ 639 ata_find_dev(parent, 0x07331039, 0) || /* SiS 733 */ 640 ata_find_dev(parent, 0x07351039, 0) || /* SiS 735 */ 641 ata_find_dev(parent, 0x07401039, 0) || /* SiS 740 */ 642 ata_find_dev(parent, 0x07451039, 0) || /* SiS 745 */ 643 ata_find_dev(parent, 0x07501039, 0)) { /* SiS 750 */ 644 int8_t reg = 0x40 + (devno << 1); 645 int16_t val = pci_read_config(parent, reg, 2) & 0x0fff; 646 647 if (udmamode >= 5) { 648 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 649 ATA_UDMA5, ATA_C_F_SETXFER, ATA_WAIT_READY); 650 if (bootverbose) 651 ata_prtdev(atadev, "%s setting UDMA5 on SiS chip\n", 652 (error) ? "failed" : "success"); 653 if (!error) { 654 pci_write_config(parent, reg, val | 0x8000, 2); 655 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 656 return; 657 } 658 } 659 if (udmamode >= 4) { 660 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 661 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 662 if (bootverbose) 663 ata_prtdev(atadev, "%s setting UDMA4 on SiS chip\n", 664 (error) ? "failed" : "success"); 665 if (!error) { 666 pci_write_config(parent, reg, val | 0x9000, 2); 667 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 668 return; 669 } 670 } 671 if (udmamode >= 2) { 672 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 673 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 674 if (bootverbose) 675 ata_prtdev(atadev, "%s setting UDMA2 on SiS chip\n", 676 (error) ? "failed" : "success"); 677 if (!error) { 678 pci_write_config(parent, reg, val | 0xb000, 2); 679 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 680 return; 681 } 682 } 683 } else if (ata_find_dev(parent, 0x05301039, 0) || /* SiS 530 */ 684 ata_find_dev(parent, 0x05401039, 0) || /* SiS 540 */ 685 ata_find_dev(parent, 0x06201039, 0) || /* SiS 620 */ 686 ata_find_dev(parent, 0x06301039, 0)) { /* SiS 630 */ 687 int8_t reg = 0x40 + (devno << 1); 688 int16_t val = pci_read_config(parent, reg, 2) & 0x0fff; 689 690 if (udmamode >= 4) { 691 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 692 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 693 if (bootverbose) 694 ata_prtdev(atadev, "%s setting UDMA4 on SiS chip\n", 695 (error) ? "failed" : "success"); 696 if (!error) { 697 pci_write_config(parent, reg, val | 0x9000, 2); 698 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 699 return; 700 } 701 } 702 if (udmamode >= 2) { 703 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 704 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 705 if (bootverbose) 706 ata_prtdev(atadev, "%s setting UDMA2 on SiS chip\n", 707 (error) ? "failed" : "success"); 708 if (!error) { 709 pci_write_config(parent, reg, val | 0xa000, 2); 710 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 711 return; 712 } 713 } 714 } else if (udmamode >= 2 && chiprev > 0xc1) { 715 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 716 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 717 if (bootverbose) 718 ata_prtdev(atadev, "%s setting UDMA2 on SiS chip\n", 719 (error) ? "failed" : "success"); 720 if (!error) { 721 pci_write_config(parent, 0x40 + (devno << 1), 0xa301, 2); 722 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 723 return; 724 } 725 } 726 if (wdmamode >=2 && apiomode >= 4) { 727 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 728 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 729 if (bootverbose) 730 ata_prtdev(atadev, "%s setting WDMA2 on SiS chip\n", 731 (error) ? "failed" : "success"); 732 if (!error) { 733 pci_write_config(parent, 0x40 + (devno << 1), 0x0301, 2); 734 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 735 return; 736 } 737 } 738 /* we could set PIO mode timings, but we assume the BIOS did that */ 739 break; 740 741 case 0x06491095: /* CMD 649 ATA100 controller */ 742 if (udmamode >= 5) { 743 u_int8_t umode; 744 745 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 746 ATA_UDMA5, ATA_C_F_SETXFER, ATA_WAIT_READY); 747 if (bootverbose) 748 ata_prtdev(atadev, "%s setting UDMA5 on CMD chip\n", 749 (error) ? "failed" : "success"); 750 if (!error) { 751 umode = pci_read_config(parent, channel ? 0x7b : 0x73, 1); 752 umode &= ~(device ? 0xca : 0x35); 753 umode |= (device ? 0x0a : 0x05); 754 pci_write_config(parent, channel ? 0x7b : 0x73, umode, 1); 755 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 756 return; 757 } 758 } 759 /* FALLTHROUGH */ 760 761 case 0x06481095: /* CMD 648 ATA66 controller */ 762 if (udmamode >= 4) { 763 u_int8_t umode; 764 765 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 766 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 767 if (bootverbose) 768 ata_prtdev(atadev, "%s setting UDMA4 on CMD chip\n", 769 (error) ? "failed" : "success"); 770 if (!error) { 771 umode = pci_read_config(parent, channel ? 0x7b : 0x73, 1); 772 umode &= ~(device ? 0xca : 0x35); 773 umode |= (device ? 0x4a : 0x15); 774 pci_write_config(parent, channel ? 0x7b : 0x73, umode, 1); 775 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 776 return; 777 } 778 } 779 if (udmamode >= 2) { 780 u_int8_t umode; 781 782 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 783 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 784 if (bootverbose) 785 ata_prtdev(atadev, "%s setting UDMA2 on CMD chip\n", 786 (error) ? "failed" : "success"); 787 if (!error) { 788 umode = pci_read_config(parent, channel ? 0x7b : 0x73, 1); 789 umode &= ~(device ? 0xca : 0x35); 790 umode |= (device ? 0x42 : 0x11); 791 pci_write_config(parent, channel ? 0x7b : 0x73, umode, 1); 792 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 793 return; 794 } 795 } 796 /* make sure eventual UDMA mode from the BIOS is disabled */ 797 pci_write_config(parent, channel ? 0x7b : 0x73, 798 pci_read_config(parent, channel ? 0x7b : 0x73, 1) & 799 ~(device ? 0xca : 0x53), 1); 800 /* FALLTHROUGH */ 801 802 case 0x06461095: /* CMD 646 ATA controller */ 803 if (wdmamode >= 2 && apiomode >= 4) { 804 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 805 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 806 if (bootverbose) 807 ata_prtdev(atadev, "%s setting WDMA2 on CMD chip\n", 808 error ? "failed" : "success"); 809 if (!error) { 810 int32_t offset = (devno < 3) ? (devno << 1) : 7; 811 812 pci_write_config(parent, 0x54 + offset, 0x3f, 1); 813 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 814 return; 815 } 816 } 817 /* we could set PIO mode timings, but we assume the BIOS did that */ 818 break; 819 820 case 0xc6931080: /* Cypress 82c693 ATA controller */ 821 if (wdmamode >= 2 && apiomode >= 4) { 822 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 823 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 824 if (bootverbose) 825 ata_prtdev(atadev, "%s setting WDMA2 on Cypress chip\n", 826 error ? "failed" : "success"); 827 if (!error) { 828 pci_write_config(atadev->channel->dev, 829 channel ? 0x4e:0x4c, 0x2020, 2); 830 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 831 return; 832 } 833 } 834 /* we could set PIO mode timings, but we assume the BIOS did that */ 835 break; 836 837 case 0x01021078: /* Cyrix 5530 ATA33 controller */ 838 atadev->channel->alignment = 0xf; 839 if (udmamode >= 2) { 840 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 841 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 842 if (bootverbose) 843 ata_prtdev(atadev, "%s setting UDMA2 on Cyrix chip\n", 844 (error) ? "failed" : "success"); 845 if (!error) { 846 cyrix_timing(atadev, devno, ATA_UDMA2); 847 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 848 return; 849 } 850 } 851 if (wdmamode >= 2 && apiomode >= 4) { 852 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 853 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 854 if (bootverbose) 855 ata_prtdev(atadev, "%s setting WDMA2 on Cyrix chip\n", 856 (error) ? "failed" : "success"); 857 if (!error) { 858 cyrix_timing(atadev, devno, ATA_WDMA2); 859 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 860 return; 861 } 862 } 863 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 864 ATA_PIO0 + apiomode, ATA_C_F_SETXFER, 865 ATA_WAIT_READY); 866 if (bootverbose) 867 ata_prtdev(atadev, "%s setting %s on Cyrix chip\n", 868 (error) ? "failed" : "success", 869 ata_mode2str(ATA_PIO0 + apiomode)); 870 cyrix_timing(atadev, devno, ATA_PIO0 + apiomode); 871 atadev->mode = ATA_PIO0 + apiomode; 872 return; 873 874 case 0x02121166: /* ServerWorks CSB5 ATA66/100 controller */ 875 if (udmamode >= 5 && chiprev >= 0x92) { 876 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 877 ATA_UDMA5, ATA_C_F_SETXFER, ATA_WAIT_READY); 878 if (bootverbose) 879 ata_prtdev(atadev, "%s setting UDMA5 on ServerWorks chip\n", 880 (error) ? "failed" : "success"); 881 if (!error) { 882 u_int16_t reg56; 883 884 pci_write_config(parent, 0x54, 885 pci_read_config(parent, 0x54, 1) | 886 (0x01 << devno), 1); 887 reg56 = pci_read_config(parent, 0x56, 2); 888 reg56 &= ~(0xf << (devno * 4)); 889 reg56 |= (0x5 << (devno * 4)); 890 pci_write_config(parent, 0x56, reg56, 2); 891 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 892 return; 893 } 894 } 895 if (udmamode >= 4) { 896 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 897 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 898 if (bootverbose) 899 ata_prtdev(atadev, "%s setting UDMA4 on ServerWorks chip\n", 900 (error) ? "failed" : "success"); 901 if (!error) { 902 u_int16_t reg56; 903 904 pci_write_config(parent, 0x54, 905 pci_read_config(parent, 0x54, 1) | 906 (0x01 << devno), 1); 907 reg56 = pci_read_config(parent, 0x56, 2); 908 reg56 &= ~(0xf << (devno * 4)); 909 reg56 |= (0x4 << (devno * 4)); 910 pci_write_config(parent, 0x56, reg56, 2); 911 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 912 return; 913 } 914 } 915 /* FALLTHROUGH */ 916 917 case 0x02111166: /* ServerWorks ROSB4 ATA33 controller */ 918 if (udmamode >= 2) { 919 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 920 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 921 if (bootverbose) 922 ata_prtdev(atadev, "%s setting UDMA2 on ServerWorks chip\n", 923 (error) ? "failed" : "success"); 924 if (!error) { 925 u_int16_t reg56; 926 927 pci_write_config(parent, 0x54, 928 pci_read_config(parent, 0x54, 1) | 929 (0x01 << devno), 1); 930 reg56 = pci_read_config(parent, 0x56, 2); 931 reg56 &= ~(0xf << (devno * 4)); 932 reg56 |= (0x2 << (devno * 4)); 933 pci_write_config(parent, 0x56, reg56, 2); 934 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 935 return; 936 } 937 } 938 if (wdmamode >= 2 && apiomode >= 4) { 939 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 940 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 941 if (bootverbose) 942 ata_prtdev(atadev, "%s setting WDMA2 on ServerWorks chip\n", 943 (error) ? "failed" : "success"); 944 if (!error) { 945 int offset = devno ^ 0x01; 946 int word44 = pci_read_config(parent, 0x44, 4); 947 948 pci_write_config(parent, 0x54, 949 pci_read_config(parent, 0x54, 1) & 950 ~(0x01 << devno), 1); 951 word44 &= ~(0xff << (offset << 8)); 952 word44 |= (0x20 << (offset << 8)); 953 pci_write_config(parent, 0x44, 0x20, 4); 954 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 955 return; 956 } 957 } 958 /* we could set PIO mode timings, but we assume the BIOS did that */ 959 break; 960 961 case 0x4d69105a: /* Promise TX2 ATA133 controllers */ 962 case 0x5275105a: /* Promise TX2 ATA133 controllers */ 963 case 0x6269105a: /* Promise TX2 ATA133 controllers */ 964 ATA_OUTB(atadev->channel->r_bmio, ATA_BMDEVSPEC_0, 0x0b); 965 if (udmamode >= 6 && 966 !(ATA_INB(atadev->channel->r_bmio, ATA_BMDEVSPEC_1) & 0x04)) { 967 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 968 ATA_UDMA6, ATA_C_F_SETXFER, ATA_WAIT_READY); 969 if (bootverbose) 970 ata_prtdev(atadev, "%s setting UDMA6 on Promise chip\n", 971 (error) ? "failed" : "success"); 972 if (!error) { 973 ata_dmacreate(atadev, apiomode, ATA_UDMA6); 974 return; 975 } 976 } 977 /* FALLTHROUGH */ 978 979 case 0x4d68105a: /* Promise TX2 ATA100 controllers */ 980 case 0x6268105a: /* Promise TX2 ATA100 controllers */ 981 ATA_OUTB(atadev->channel->r_bmio, ATA_BMDEVSPEC_0, 0x0b); 982 if (udmamode >= 5 && 983 !(ATA_INB(atadev->channel->r_bmio, ATA_BMDEVSPEC_1) & 0x04)) { 984 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 985 ATA_UDMA5, ATA_C_F_SETXFER, ATA_WAIT_READY); 986 if (bootverbose) 987 ata_prtdev(atadev, "%s setting UDMA5 on Promise chip\n", 988 (error) ? "failed" : "success"); 989 if (!error) { 990 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 991 return; 992 } 993 } 994 ATA_OUTB(atadev->channel->r_bmio, ATA_BMDEVSPEC_0, 0x0b); 995 if (udmamode >= 4 && 996 !(ATA_INB(atadev->channel->r_bmio, ATA_BMDEVSPEC_1) & 0x04)) { 997 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 998 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 999 if (bootverbose) 1000 ata_prtdev(atadev, "%s setting UDMA4 on Promise chip\n", 1001 (error) ? "failed" : "success"); 1002 if (!error) { 1003 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 1004 return; 1005 } 1006 } 1007 if (udmamode >= 2) { 1008 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1009 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 1010 if (bootverbose) 1011 ata_prtdev(atadev, "%s setting UDMA on Promise chip\n", 1012 (error) ? "failed" : "success"); 1013 if (!error) { 1014 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 1015 return; 1016 } 1017 } 1018 if (wdmamode >= 2 && apiomode >= 4) { 1019 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1020 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 1021 if (bootverbose) 1022 ata_prtdev(atadev, "%s setting WDMA2 on Promise chip\n", 1023 (error) ? "failed" : "success"); 1024 if (!error) { 1025 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 1026 return; 1027 } 1028 } 1029 break; 1030 1031 case 0x0d30105a: /* Promise OEM ATA100 controllers */ 1032 case 0x4d30105a: /* Promise Ultra/FastTrak 100 controllers */ 1033 if (!ATAPI_DEVICE(atadev) && udmamode >= 5 && 1034 !(pci_read_config(parent, 0x50, 2) & (channel ? 1<<11 : 1<<10))) { 1035 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1036 ATA_UDMA5, ATA_C_F_SETXFER, ATA_WAIT_READY); 1037 if (bootverbose) 1038 ata_prtdev(atadev, "%s setting UDMA5 on Promise chip\n", 1039 (error) ? "failed" : "success"); 1040 if (!error) { 1041 promise_timing(atadev, devno, ATA_UDMA5); 1042 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 1043 return; 1044 } 1045 } 1046 /* FALLTHROUGH */ 1047 1048 case 0x0d38105a: /* Promise FastTrak 66 controllers */ 1049 case 0x4d38105a: /* Promise Ultra/FastTrak 66 controllers */ 1050 if (!ATAPI_DEVICE(atadev) && udmamode >= 4 && 1051 !(pci_read_config(parent, 0x50, 2) & (channel ? 1<<11 : 1<<10))) { 1052 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1053 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 1054 if (bootverbose) 1055 ata_prtdev(atadev, "%s setting UDMA4 on Promise chip\n", 1056 (error) ? "failed" : "success"); 1057 if (!error) { 1058 promise_timing(atadev, devno, ATA_UDMA4); 1059 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 1060 return; 1061 } 1062 } 1063 /* FALLTHROUGH */ 1064 1065 case 0x4d33105a: /* Promise Ultra/FastTrak 33 controllers */ 1066 if (!ATAPI_DEVICE(atadev) && udmamode >= 2) { 1067 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1068 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 1069 if (bootverbose) 1070 ata_prtdev(atadev, "%s setting UDMA2 on Promise chip\n", 1071 (error) ? "failed" : "success"); 1072 if (!error) { 1073 promise_timing(atadev, devno, ATA_UDMA2); 1074 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 1075 return; 1076 } 1077 } 1078 if (!ATAPI_DEVICE(atadev) && wdmamode >= 2 && apiomode >= 4) { 1079 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1080 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 1081 if (bootverbose) 1082 ata_prtdev(atadev, "%s setting WDMA2 on Promise chip\n", 1083 (error) ? "failed" : "success"); 1084 if (!error) { 1085 promise_timing(atadev, devno, ATA_WDMA2); 1086 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 1087 return; 1088 } 1089 } 1090 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1091 ATA_PIO0 + apiomode, 1092 ATA_C_F_SETXFER, ATA_WAIT_READY); 1093 if (bootverbose) 1094 ata_prtdev(atadev, "%s setting PIO%d on Promise chip\n", 1095 (error) ? "failed" : "success", 1096 (apiomode >= 0) ? apiomode : 0); 1097 promise_timing(atadev, devno, ATA_PIO0 + apiomode); 1098 atadev->mode = ATA_PIO0 + apiomode; 1099 return; 1100 1101 case 0x00041103: /* HighPoint HPT366/368/370/372 controllers */ 1102 case 0x00051103: /* HighPoint HPT372 controllers */ 1103 case 0x00081103: /* HighPoint HPT374 controllers */ 1104 if (!ATAPI_DEVICE(atadev) && udmamode >= 6 && hpt_cable80(atadev) && 1105 ((chiptype == 0x00041103 && chiprev >= 0x05) || 1106 (chiptype == 0x00051103 && chiprev >= 0x01) || 1107 (chiptype == 0x00081103 && chiprev >= 0x07))) { 1108 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1109 ATA_UDMA6, ATA_C_F_SETXFER, ATA_WAIT_READY); 1110 if (bootverbose) 1111 ata_prtdev(atadev, "%s setting UDMA6 on HighPoint chip\n", 1112 (error) ? "failed" : "success"); 1113 if (!error) { 1114 hpt_timing(atadev, devno, ATA_UDMA6); 1115 ata_dmacreate(atadev, apiomode, ATA_UDMA6); 1116 return; 1117 } 1118 } 1119 if (!ATAPI_DEVICE(atadev) && udmamode >= 5 && hpt_cable80(atadev) && 1120 ((chiptype == 0x00041103 && chiprev >= 0x03) || 1121 (chiptype == 0x00051103 && chiprev >= 0x01) || 1122 (chiptype == 0x00081103 && chiprev >= 0x07))) { 1123 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1124 ATA_UDMA5, ATA_C_F_SETXFER, ATA_WAIT_READY); 1125 if (bootverbose) 1126 ata_prtdev(atadev, "%s setting UDMA5 on HighPoint chip\n", 1127 (error) ? "failed" : "success"); 1128 if (!error) { 1129 hpt_timing(atadev, devno, ATA_UDMA5); 1130 ata_dmacreate(atadev, apiomode, ATA_UDMA5); 1131 return; 1132 } 1133 } 1134 if (!ATAPI_DEVICE(atadev) && udmamode >= 4 && hpt_cable80(atadev)) { 1135 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1136 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY); 1137 if (bootverbose) 1138 ata_prtdev(atadev, "%s setting UDMA4 on HighPoint chip\n", 1139 (error) ? "failed" : "success"); 1140 if (!error) { 1141 hpt_timing(atadev, devno, ATA_UDMA4); 1142 ata_dmacreate(atadev, apiomode, ATA_UDMA4); 1143 return; 1144 } 1145 } 1146 if (!ATAPI_DEVICE(atadev) && udmamode >= 2) { 1147 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1148 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 1149 if (bootverbose) 1150 ata_prtdev(atadev, "%s setting UDMA2 on HighPoint chip\n", 1151 (error) ? "failed" : "success"); 1152 if (!error) { 1153 hpt_timing(atadev, devno, ATA_UDMA2); 1154 ata_dmacreate(atadev, apiomode, ATA_UDMA2); 1155 return; 1156 } 1157 } 1158 if (!ATAPI_DEVICE(atadev) && wdmamode >= 2 && apiomode >= 4) { 1159 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1160 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 1161 if (bootverbose) 1162 ata_prtdev(atadev, "%s setting WDMA2 on HighPoint chip\n", 1163 (error) ? "failed" : "success"); 1164 if (!error) { 1165 hpt_timing(atadev, devno, ATA_WDMA2); 1166 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 1167 return; 1168 } 1169 } 1170 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1171 ATA_PIO0 + apiomode, 1172 ATA_C_F_SETXFER, ATA_WAIT_READY); 1173 if (bootverbose) 1174 ata_prtdev(atadev, "%s setting PIO%d on HighPoint chip\n", 1175 (error) ? "failed" : "success", 1176 (apiomode >= 0) ? apiomode : 0); 1177 hpt_timing(atadev, devno, ATA_PIO0 + apiomode); 1178 atadev->mode = ATA_PIO0 + apiomode; 1179 return; 1180 1181 case 0x000116ca: /* Cenatek Rocket Drive controller */ 1182 if (wdmamode >= 0 && 1183 (ATA_INB(atadev->channel->r_bmio, ATA_BMSTAT_PORT) & 1184 (device ? ATA_BMSTAT_DMA_SLAVE : ATA_BMSTAT_DMA_MASTER))) 1185 ata_dmacreate(atadev, apiomode, ATA_DMA); 1186 else 1187 atadev->mode = ATA_PIO; 1188 return; 1189 1190 default: /* unknown controller chip */ 1191 /* better not try generic DMA on ATAPI devices it almost never works */ 1192 if (ATAPI_DEVICE(atadev)) 1193 break; 1194 1195 /* if controller says its setup for DMA take the easy way out */ 1196 /* the downside is we dont know what DMA mode we are in */ 1197 if ((udmamode >= 0 || wdmamode >= 2) && 1198 (ATA_INB(atadev->channel->r_bmio, ATA_BMSTAT_PORT) & 1199 (device ? ATA_BMSTAT_DMA_SLAVE : ATA_BMSTAT_DMA_MASTER))) { 1200 ata_dmacreate(atadev, apiomode, ATA_DMA); 1201 return; 1202 } 1203 1204 /* well, we have no support for this, but try anyways */ 1205 if ((wdmamode >= 2 && apiomode >= 4) && atadev->channel->r_bmio) { 1206 error = ata_command(atadev, ATA_C_SETFEATURES, 0, 1207 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY); 1208 if (bootverbose) 1209 ata_prtdev(atadev, "%s setting WDMA2 on generic chip\n", 1210 (error) ? "failed" : "success"); 1211 if (!error) { 1212 ata_dmacreate(atadev, apiomode, ATA_WDMA2); 1213 return; 1214 } 1215 } 1216 } 1217 error = ata_command(atadev, ATA_C_SETFEATURES, 0, ATA_PIO0 + apiomode, 1218 ATA_C_F_SETXFER, ATA_WAIT_READY); 1219 if (bootverbose) 1220 ata_prtdev(atadev, "%s setting PIO%d on generic chip\n", 1221 (error) ? "failed" : "success", apiomode < 0 ? 0 : apiomode); 1222 if (!error) 1223 atadev->mode = ATA_PIO0 + apiomode; 1224 else { 1225 if (bootverbose) 1226 ata_prtdev(atadev, "using PIO mode set by BIOS\n"); 1227 atadev->mode = ATA_PIO; 1228 } 1229} 1230 1231struct ata_dmasetup_data_cb_args { 1232 struct ata_dmaentry *dmatab; 1233 int error; 1234}; 1235 1236static void 1237ata_dmasetupd_cb(void *xsc, bus_dma_segment_t *segs, int nsegs, int error) 1238{ 1239 struct ata_dmasetup_data_cb_args *cba = 1240 (struct ata_dmasetup_data_cb_args *)xsc; 1241 bus_size_t cnt; 1242 u_int32_t lastcount; 1243 int i, j; 1244 1245 cba->error = error; 1246 if (error != 0) 1247 return; 1248 lastcount = j = 0; 1249 for (i = 0; i < nsegs; i++) { 1250 /* 1251 * A maximum segment size was specified for bus_dma_tag_create, but 1252 * some busdma code does not seem to honor this, so fix up if needed. 1253 */ 1254 for (cnt = 0; cnt < segs[i].ds_len; cnt += MAXSEGSZ, j++) { 1255 cba->dmatab[j].base = htole32(segs[i].ds_addr + cnt); 1256 lastcount = ulmin(segs[i].ds_len - cnt, MAXSEGSZ) & 0xffff; 1257 cba->dmatab[j].count = htole32(lastcount); 1258 } 1259 } 1260 cba->dmatab[j - 1].count = htole32(lastcount | ATA_DMA_EOT); 1261} 1262 1263int 1264ata_dmasetup(struct ata_device *atadev, caddr_t data, int32_t count) 1265{ 1266 struct ata_channel *ch = atadev->channel; 1267 1268 if (((uintptr_t)data & ch->alignment) || (count & ch->alignment)) { 1269 ata_prtdev(atadev, "non aligned DMA transfer attempted\n"); 1270 return -1; 1271 } 1272 1273 if (!count) { 1274 ata_prtdev(atadev, "zero length DMA transfer attempted\n"); 1275 return -1; 1276 } 1277 return 0; 1278} 1279 1280int 1281ata_dmastart(struct ata_device *atadev, caddr_t data, int32_t count, int dir) 1282{ 1283 struct ata_channel *ch = atadev->channel; 1284 struct ata_dmastate *ds = &atadev->dmastate; 1285 struct ata_dmasetup_data_cb_args cba; 1286 1287 if (ds->flags & ATA_DS_ACTIVE) 1288 panic("ata_dmasetup: transfer active on this device!"); 1289 1290 cba.dmatab = ds->dmatab; 1291 bus_dmamap_sync(ds->cdmatag, ds->cdmamap, BUS_DMASYNC_PREWRITE); 1292 if (bus_dmamap_load(ds->ddmatag, ds->ddmamap, data, count, 1293 ata_dmasetupd_cb, &cba, 0) || cba.error) 1294 return -1; 1295 1296 bus_dmamap_sync(ds->cdmatag, ds->cdmamap, BUS_DMASYNC_POSTWRITE); 1297 bus_dmamap_sync(ds->ddmatag, ds->ddmamap, dir ? BUS_DMASYNC_PREREAD : 1298 BUS_DMASYNC_PREWRITE); 1299 1300 ch->flags |= ATA_DMA_ACTIVE; 1301 ds->flags = ATA_DS_ACTIVE; 1302 if (dir) 1303 ds->flags |= ATA_DS_READ; 1304 1305 ATA_OUTL(ch->r_bmio, ATA_BMDTP_PORT, ds->mdmatab); 1306 ATA_OUTB(ch->r_bmio, ATA_BMCMD_PORT, dir ? ATA_BMCMD_WRITE_READ : 0); 1307 ATA_OUTB(ch->r_bmio, ATA_BMSTAT_PORT, 1308 (ATA_INB(ch->r_bmio, ATA_BMSTAT_PORT) | 1309 (ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR))); 1310 ATA_OUTB(ch->r_bmio, ATA_BMCMD_PORT, 1311 ATA_INB(ch->r_bmio, ATA_BMCMD_PORT) | ATA_BMCMD_START_STOP); 1312 return 0; 1313} 1314 1315int 1316ata_dmadone(struct ata_device *atadev) 1317{ 1318 struct ata_channel *ch; 1319 struct ata_dmastate *ds; 1320 int error; 1321 1322 ch = atadev->channel; 1323 ds = &atadev->dmastate; 1324 bus_dmamap_sync(ds->ddmatag, ds->ddmamap, (ds->flags & ATA_DS_READ) != 0 ? 1325 BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE); 1326 bus_dmamap_unload(ds->ddmatag, ds->ddmamap); 1327 1328 ATA_OUTB(ch->r_bmio, ATA_BMCMD_PORT, 1329 ATA_INB(ch->r_bmio, ATA_BMCMD_PORT) & ~ATA_BMCMD_START_STOP); 1330 error = ATA_INB(ch->r_bmio, ATA_BMSTAT_PORT); 1331 ATA_OUTB(ch->r_bmio, ATA_BMSTAT_PORT, 1332 error | ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR); 1333 ch->flags &= ~ATA_DMA_ACTIVE; 1334 ds->flags = 0; 1335 return (error & ATA_BMSTAT_MASK); 1336} 1337 1338int 1339ata_dmastatus(struct ata_channel *ch) 1340{ 1341 return ATA_INB(ch->r_bmio, ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK; 1342} 1343 1344static void 1345cyrix_timing(struct ata_device *atadev, int devno, int mode) 1346{ 1347 u_int32_t reg20 = 0x0000e132; 1348 u_int32_t reg24 = 0x00017771; 1349 1350 switch (mode) { 1351 case ATA_PIO0: reg20 = 0x0000e132; break; 1352 case ATA_PIO1: reg20 = 0x00018121; break; 1353 case ATA_PIO2: reg20 = 0x00024020; break; 1354 case ATA_PIO3: reg20 = 0x00032010; break; 1355 case ATA_PIO4: reg20 = 0x00040010; break; 1356 case ATA_WDMA2: reg24 = 0x00002020; break; 1357 case ATA_UDMA2: reg24 = 0x00911030; break; 1358 } 1359 ATA_OUTL(atadev->channel->r_bmio, (devno << 3) + 0x20, reg20); 1360 ATA_OUTL(atadev->channel->r_bmio, (devno << 3) + 0x24, reg24); 1361} 1362 1363static void 1364promise_timing(struct ata_device *atadev, int devno, int mode) 1365{ 1366 u_int32_t timing = 0; 1367 /* XXX: Endianess */ 1368 struct promise_timing { 1369 u_int8_t pa:4; 1370 u_int8_t prefetch:1; 1371 u_int8_t iordy:1; 1372 u_int8_t errdy:1; 1373 u_int8_t syncin:1; 1374 u_int8_t pb:5; 1375 u_int8_t mb:3; 1376 u_int8_t mc:4; 1377 u_int8_t dmaw:1; 1378 u_int8_t dmar:1; 1379 u_int8_t iordyp:1; 1380 u_int8_t dmarqp:1; 1381 u_int8_t reserved:8; 1382 } *t = (struct promise_timing*)&timing; 1383 1384 t->iordy = 1; t->iordyp = 1; 1385 if (mode >= ATA_DMA) { 1386 t->prefetch = 1; t->errdy = 1; t->syncin = 1; 1387 } 1388 1389 switch (atadev->channel->chiptype) { 1390 case 0x4d33105a: /* Promise Ultra/Fasttrak 33 */ 1391 switch (mode) { 1392 default: 1393 case ATA_PIO0: t->pa = 9; t->pb = 19; t->mb = 7; t->mc = 15; break; 1394 case ATA_PIO1: t->pa = 5; t->pb = 12; t->mb = 7; t->mc = 15; break; 1395 case ATA_PIO2: t->pa = 3; t->pb = 8; t->mb = 7; t->mc = 15; break; 1396 case ATA_PIO3: t->pa = 2; t->pb = 6; t->mb = 7; t->mc = 15; break; 1397 case ATA_PIO4: t->pa = 1; t->pb = 4; t->mb = 7; t->mc = 15; break; 1398 case ATA_WDMA2: t->pa = 3; t->pb = 7; t->mb = 3; t->mc = 3; break; 1399 case ATA_UDMA2: t->pa = 3; t->pb = 7; t->mb = 1; t->mc = 1; break; 1400 } 1401 break; 1402 1403 case 0x0d38105a: /* Promise Fasttrak 66 */ 1404 case 0x4d38105a: /* Promise Ultra/Fasttrak 66 */ 1405 case 0x0d30105a: /* Promise OEM ATA 100 */ 1406 case 0x4d30105a: /* Promise Ultra/Fasttrak 100 */ 1407 switch (mode) { 1408 default: 1409 case ATA_PIO0: t->pa = 15; t->pb = 31; t->mb = 7; t->mc = 15; break; 1410 case ATA_PIO1: t->pa = 10; t->pb = 24; t->mb = 7; t->mc = 15; break; 1411 case ATA_PIO2: t->pa = 6; t->pb = 16; t->mb = 7; t->mc = 15; break; 1412 case ATA_PIO3: t->pa = 4; t->pb = 12; t->mb = 7; t->mc = 15; break; 1413 case ATA_PIO4: t->pa = 2; t->pb = 8; t->mb = 7; t->mc = 15; break; 1414 case ATA_WDMA2: t->pa = 6; t->pb = 14; t->mb = 6; t->mc = 6; break; 1415 case ATA_UDMA2: t->pa = 6; t->pb = 14; t->mb = 2; t->mc = 2; break; 1416 case ATA_UDMA4: t->pa = 3; t->pb = 7; t->mb = 1; t->mc = 1; break; 1417 case ATA_UDMA5: t->pa = 3; t->pb = 7; t->mb = 1; t->mc = 1; break; 1418 } 1419 break; 1420 } 1421 pci_write_config(device_get_parent(atadev->channel->dev), 1422 0x60 + (devno << 2), timing, 4); 1423} 1424 1425static void 1426hpt_timing(struct ata_device *atadev, int devno, int mode) 1427{ 1428 device_t parent = device_get_parent(atadev->channel->dev); 1429 u_int32_t chiptype = atadev->channel->chiptype; 1430 int chiprev = pci_get_revid(parent); 1431 u_int32_t timing; 1432 1433 if (chiptype == 0x00081103 && chiprev >= 0x07) { 1434 switch (mode) { /* HPT374 */ 1435 case ATA_PIO0: timing = 0x0ac1f48a; break; 1436 case ATA_PIO1: timing = 0x0ac1f465; break; 1437 case ATA_PIO2: timing = 0x0a81f454; break; 1438 case ATA_PIO3: timing = 0x0a81f443; break; 1439 case ATA_PIO4: timing = 0x0a81f442; break; 1440 case ATA_WDMA2: timing = 0x22808242; break; 1441 case ATA_UDMA2: timing = 0x120c8242; break; 1442 case ATA_UDMA4: timing = 0x12ac8242; break; 1443 case ATA_UDMA5: timing = 0x12848242; break; 1444 case ATA_UDMA6: timing = 0x12808242; break; 1445 default: timing = 0x0d029d5e; 1446 } 1447 } 1448 else if ((chiptype == 0x00041103 && chiprev >= 0x05) || 1449 (chiptype == 0x00051103 && chiprev >= 0x01)) { 1450 switch (mode) { /* HPT372 */ 1451 case ATA_PIO0: timing = 0x0d029d5e; break; 1452 case ATA_PIO1: timing = 0x0d029d26; break; 1453 case ATA_PIO2: timing = 0x0c829ca6; break; 1454 case ATA_PIO3: timing = 0x0c829c84; break; 1455 case ATA_PIO4: timing = 0x0c829c62; break; 1456 case ATA_WDMA2: timing = 0x2c829262; break; 1457 case ATA_UDMA2: timing = 0x1c91dc62; break; 1458 case ATA_UDMA4: timing = 0x1c8ddc62; break; 1459 case ATA_UDMA5: timing = 0x1c6ddc62; break; 1460 case ATA_UDMA6: timing = 0x1c81dc62; break; 1461 default: timing = 0x0d029d5e; 1462 } 1463 } 1464 else if (chiptype == 0x00041103 && chiprev >= 0x03) { 1465 switch (mode) { /* HPT370 */ 1466 case ATA_PIO0: timing = 0x06914e57; break; 1467 case ATA_PIO1: timing = 0x06914e43; break; 1468 case ATA_PIO2: timing = 0x06514e33; break; 1469 case ATA_PIO3: timing = 0x06514e22; break; 1470 case ATA_PIO4: timing = 0x06514e21; break; 1471 case ATA_WDMA2: timing = 0x26514e21; break; 1472 case ATA_UDMA2: timing = 0x16494e31; break; 1473 case ATA_UDMA4: timing = 0x16454e31; break; 1474 case ATA_UDMA5: timing = 0x16454e31; break; 1475 default: timing = 0x06514e57; 1476 } 1477 pci_write_config(parent, 0x40 + (devno << 2) , timing, 4); 1478 } 1479 else { /* HPT36[68] */ 1480 switch (pci_read_config(parent, 0x41 + (devno << 2), 1)) { 1481 case 0x85: /* 25Mhz */ 1482 switch (mode) { 1483 case ATA_PIO0: timing = 0x40d08585; break; 1484 case ATA_PIO1: timing = 0x40d08572; break; 1485 case ATA_PIO2: timing = 0x40ca8542; break; 1486 case ATA_PIO3: timing = 0x40ca8532; break; 1487 case ATA_PIO4: timing = 0x40ca8521; break; 1488 case ATA_WDMA2: timing = 0x20ca8521; break; 1489 case ATA_UDMA2: timing = 0x10cf8521; break; 1490 case ATA_UDMA4: timing = 0x10c98521; break; 1491 default: timing = 0x01208585; 1492 } 1493 break; 1494 default: 1495 case 0xa7: /* 33MHz */ 1496 switch (mode) { 1497 case ATA_PIO0: timing = 0x40d0a7aa; break; 1498 case ATA_PIO1: timing = 0x40d0a7a3; break; 1499 case ATA_PIO2: timing = 0x40d0a753; break; 1500 case ATA_PIO3: timing = 0x40c8a742; break; 1501 case ATA_PIO4: timing = 0x40c8a731; break; 1502 case ATA_WDMA2: timing = 0x20c8a731; break; 1503 case ATA_UDMA2: timing = 0x10caa731; break; 1504 case ATA_UDMA4: timing = 0x10c9a731; break; 1505 default: timing = 0x0120a7a7; 1506 } 1507 break; 1508 case 0xd9: /* 40Mhz */ 1509 switch (mode) { 1510 case ATA_PIO0: timing = 0x4018d9d9; break; 1511 case ATA_PIO1: timing = 0x4010d9c7; break; 1512 case ATA_PIO2: timing = 0x4010d997; break; 1513 case ATA_PIO3: timing = 0x4010d974; break; 1514 case ATA_PIO4: timing = 0x4008d963; break; 1515 case ATA_WDMA2: timing = 0x2008d943; break; 1516 case ATA_UDMA2: timing = 0x100bd943; break; 1517 case ATA_UDMA4: timing = 0x100fd943; break; 1518 default: timing = 0x0120d9d9; 1519 } 1520 } 1521 } 1522 pci_write_config(parent, 0x40 + (devno << 2) , timing, 4); 1523} 1524 1525static int 1526hpt_cable80(struct ata_device *atadev) 1527{ 1528 device_t parent = device_get_parent(atadev->channel->dev); 1529 u_int8_t reg, val, res; 1530 1531 if (atadev->channel->chiptype==0x00081103 && pci_get_function(parent)==1) { 1532 reg = atadev->channel->unit ? 0x57 : 0x53; 1533 val = pci_read_config(parent, reg, 1); 1534 pci_write_config(parent, reg, val | 0x80, 1); 1535 } 1536 else { 1537 reg = 0x5b; 1538 val = pci_read_config(parent, reg, 1); 1539 pci_write_config(parent, reg, val & 0xfe, 1); 1540 } 1541 res = pci_read_config(parent, 0x5a, 1) & (atadev->channel->unit ? 0x1:0x2); 1542 pci_write_config(parent, reg, val, 1); 1543 return !res; 1544}
|