drivers/ata/pata_hpt37x.c

   1 /*
   2  * Libata driver for the highpoint 37x and 30x UDMA66 ATA controllers.
   3  *
   4  * This driver is heavily based upon:
   5  *
   6  * linux/drivers/ide/pci/hpt366.c               Version 0.36    April 25, 2003
   7  *
   8  * Copyright (C) 1999-2003              Andre Hedrick <andre@linux-ide.org>
   9  * Portions Copyright (C) 2001          Sun Microsystems, Inc.
  10  * Portions Copyright (C) 2003          Red Hat Inc
  11  * Portions Copyright (C) 2005-2010     MontaVista Software, Inc.
  12  *
  13  * TODO
  14  *      Look into engine reset on timeout errors. Should not be required.
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include <linux/module.h>
  19 #include <linux/pci.h>
  20 #include <linux/init.h>
  21 #include <linux/blkdev.h>
  22 #include <linux/delay.h>
  23 #include <scsi/scsi_host.h>
  24 #include <linux/libata.h>
  25
  26 #define DRV_NAME        "pata_hpt37x"
  27 #define DRV_VERSION     "0.6.18"
  28
  29 struct hpt_clock {
  30         u8      xfer_speed;
  31         u32     timing;
  32 };
  33
  34 struct hpt_chip {
  35         const char *name;
  36         unsigned int base;
  37         struct hpt_clock const *clocks[4];
  38 };
  39
  40 /* key for bus clock timings
  41  * bit
  42  * 0:3    data_high_time. Inactive time of DIOW_/DIOR_ for PIO and MW DMA.
  43  *        cycles = value + 1
  44  * 4:8    data_low_time. Active time of DIOW_/DIOR_ for PIO and MW DMA.
  45  *        cycles = value + 1
  46  * 9:12   cmd_high_time. Inactive time of DIOW_/DIOR_ during task file
  47  *        register access.
  48  * 13:17  cmd_low_time. Active time of DIOW_/DIOR_ during task file
  49  *        register access.
  50  * 18:20  udma_cycle_time. Clock cycles for UDMA xfer.
  51  * 21     CLK frequency for UDMA: 0=ATA clock, 1=dual ATA clock.
  52  * 22:24  pre_high_time. Time to initialize 1st cycle for PIO and MW DMA xfer.
  53  * 25:27  cmd_pre_high_time. Time to initialize 1st PIO cycle for task file
  54  *        register access.
  55  * 28     UDMA enable.
  56  * 29     DMA  enable.
  57  * 30     PIO_MST enable. If set, the chip is in bus master mode during
  58  *        PIO xfer.
  59  * 31     FIFO enable. Only for PIO.
  60  */
  61
  62 static struct hpt_clock hpt37x_timings_33[] = {
  63         { XFER_UDMA_6,          0x12446231 },   /* 0x12646231 ?? */
  64         { XFER_UDMA_5,          0x12446231 },
  65         { XFER_UDMA_4,          0x12446231 },
  66         { XFER_UDMA_3,          0x126c6231 },
  67         { XFER_UDMA_2,          0x12486231 },
  68         { XFER_UDMA_1,          0x124c6233 },
  69         { XFER_UDMA_0,          0x12506297 },
  70
  71         { XFER_MW_DMA_2,        0x22406c31 },
  72         { XFER_MW_DMA_1,        0x22406c33 },
  73         { XFER_MW_DMA_0,        0x22406c97 },
  74
  75         { XFER_PIO_4,           0x06414e31 },
  76         { XFER_PIO_3,           0x06414e42 },
  77         { XFER_PIO_2,           0x06414e53 },
  78         { XFER_PIO_1,           0x06814e93 },
  79         { XFER_PIO_0,           0x06814ea7 }
  80 };
  81
  82 static struct hpt_clock hpt37x_timings_50[] = {
  83         { XFER_UDMA_6,          0x12848242 },
  84         { XFER_UDMA_5,          0x12848242 },
  85         { XFER_UDMA_4,          0x12ac8242 },
  86         { XFER_UDMA_3,          0x128c8242 },
  87         { XFER_UDMA_2,          0x120c8242 },
  88         { XFER_UDMA_1,          0x12148254 },
  89         { XFER_UDMA_0,          0x121882ea },
  90
  91         { XFER_MW_DMA_2,        0x22808242 },
  92         { XFER_MW_DMA_1,        0x22808254 },
  93         { XFER_MW_DMA_0,        0x228082ea },
  94
  95         { XFER_PIO_4,           0x0a81f442 },
  96         { XFER_PIO_3,           0x0a81f443 },
  97         { XFER_PIO_2,           0x0a81f454 },
  98         { XFER_PIO_1,           0x0ac1f465 },
  99         { XFER_PIO_0,           0x0ac1f48a }
 100 };
 101
 102 static struct hpt_clock hpt37x_timings_66[] = {
 103         { XFER_UDMA_6,          0x1c869c62 },
 104         { XFER_UDMA_5,          0x1cae9c62 },   /* 0x1c8a9c62 */
 105         { XFER_UDMA_4,          0x1c8a9c62 },
 106         { XFER_UDMA_3,          0x1c8e9c62 },
 107         { XFER_UDMA_2,          0x1c929c62 },
 108         { XFER_UDMA_1,          0x1c9a9c62 },
 109         { XFER_UDMA_0,          0x1c829c62 },
 110
 111         { XFER_MW_DMA_2,        0x2c829c62 },
 112         { XFER_MW_DMA_1,        0x2c829c66 },
 113         { XFER_MW_DMA_0,        0x2c829d2e },
 114
 115         { XFER_PIO_4,           0x0c829c62 },
 116         { XFER_PIO_3,           0x0c829c84 },
 117         { XFER_PIO_2,           0x0c829ca6 },
 118         { XFER_PIO_1,           0x0d029d26 },
 119         { XFER_PIO_0,           0x0d029d5e }
 120 };
 121
 122
 123 static const struct hpt_chip hpt370 = {
 124         "HPT370",
 125         48,
 126         {
 127                 hpt37x_timings_33,
 128                 NULL,
 129                 NULL,
 130                 NULL
 131         }
 132 };
 133
 134 static const struct hpt_chip hpt370a = {
 135         "HPT370A",
 136         48,
 137         {
 138                 hpt37x_timings_33,
 139                 NULL,
 140                 hpt37x_timings_50,
 141                 NULL
 142         }
 143 };
 144
 145 static const struct hpt_chip hpt372 = {
 146         "HPT372",
 147         55,
 148         {
 149                 hpt37x_timings_33,
 150                 NULL,
 151                 hpt37x_timings_50,
 152                 hpt37x_timings_66
 153         }
 154 };
 155
 156 static const struct hpt_chip hpt302 = {
 157         "HPT302",
 158         66,
 159         {
 160                 hpt37x_timings_33,
 161                 NULL,
 162                 hpt37x_timings_50,
 163                 hpt37x_timings_66
 164         }
 165 };
 166
 167 static const struct hpt_chip hpt371 = {
 168         "HPT371",
 169         66,
 170         {
 171                 hpt37x_timings_33,
 172                 NULL,
 173                 hpt37x_timings_50,
 174                 hpt37x_timings_66
 175         }
 176 };
 177
 178 static const struct hpt_chip hpt372a = {
 179         "HPT372A",
 180         66,
 181         {
 182                 hpt37x_timings_33,
 183                 NULL,
 184                 hpt37x_timings_50,
 185                 hpt37x_timings_66
 186         }
 187 };
 188
 189 static const struct hpt_chip hpt374 = {
 190         "HPT374",
 191         48,
 192         {
 193                 hpt37x_timings_33,
 194                 NULL,
 195                 NULL,
 196                 NULL
 197         }
 198 };
 199
 200 /**
 201  *      hpt37x_find_mode        -       reset the hpt37x bus
 202  *      @ap: ATA port
 203  *      @speed: transfer mode
 204  *
 205  *      Return the 32bit register programming information for this channel
 206  *      that matches the speed provided.
 207  */
 208
 209 static u32 hpt37x_find_mode(struct ata_port *ap, int speed)
 210 {
 211         struct hpt_clock *clocks = ap->host->private_data;
 212
 213         while (clocks->xfer_speed) {
 214                 if (clocks->xfer_speed == speed)
 215                         return clocks->timing;
 216                 clocks++;
 217         }
 218         BUG();
 219         return 0xffffffffU;     /* silence compiler warning */
 220 }
 221
 222 static int hpt_dma_blacklisted(const struct ata_device *dev, char *modestr,
 223                                const char * const list[])
 224 {
 225         unsigned char model_num[ATA_ID_PROD_LEN + 1];
 226         int i = 0;
 227
 228         ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num));
 229
 230         while (list[i] != NULL) {
 231                 if (!strcmp(list[i], model_num)) {
 232                         printk(KERN_WARNING DRV_NAME ": %s is not supported for %s.\n",
 233                                 modestr, list[i]);
 234                         return 1;
 235                 }
 236                 i++;
 237         }
 238         return 0;
 239 }
 240
 241 static const char * const bad_ata33[] = {
 242         "Maxtor 92720U8", "Maxtor 92040U6", "Maxtor 91360U4", "Maxtor 91020U3",
 243         "Maxtor 90845U3", "Maxtor 90650U2",
 244         "Maxtor 91360D8", "Maxtor 91190D7", "Maxtor 91020D6", "Maxtor 90845D5",
 245         "Maxtor 90680D4", "Maxtor 90510D3", "Maxtor 90340D2",
 246         "Maxtor 91152D8", "Maxtor 91008D7", "Maxtor 90845D6", "Maxtor 90840D6",
 247         "Maxtor 90720D5", "Maxtor 90648D5", "Maxtor 90576D4",
 248         "Maxtor 90510D4",
 249         "Maxtor 90432D3", "Maxtor 90288D2", "Maxtor 90256D2",
 250         "Maxtor 91000D8", "Maxtor 90910D8", "Maxtor 90875D7", "Maxtor 90840D7",
 251         "Maxtor 90750D6", "Maxtor 90625D5", "Maxtor 90500D4",
 252         "Maxtor 91728D8", "Maxtor 91512D7", "Maxtor 91303D6", "Maxtor 91080D5",
 253         "Maxtor 90845D4", "Maxtor 90680D4", "Maxtor 90648D3", "Maxtor 90432D2",
 254         NULL
 255 };
 256
 257 static const char * const bad_ata100_5[] = {
 258         "IBM-DTLA-307075",
 259         "IBM-DTLA-307060",
 260         "IBM-DTLA-307045",
 261         "IBM-DTLA-307030",
 262         "IBM-DTLA-307020",
 263         "IBM-DTLA-307015",
 264         "IBM-DTLA-305040",
 265         "IBM-DTLA-305030",
 266         "IBM-DTLA-305020",
 267         "IC35L010AVER07-0",
 268         "IC35L020AVER07-0",
 269         "IC35L030AVER07-0",
 270         "IC35L040AVER07-0",
 271         "IC35L060AVER07-0",
 272         "WDC AC310200R",
 273         NULL
 274 };
 275
 276 /**
 277  *      hpt370_filter   -       mode selection filter
 278  *      @adev: ATA device
 279  *
 280  *      Block UDMA on devices that cause trouble with this controller.
 281  */
 282
 283 static unsigned long hpt370_filter(struct ata_device *adev, unsigned long mask)
 284 {
 285         if (adev->class == ATA_DEV_ATA) {
 286                 if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33))
 287                         mask &= ~ATA_MASK_UDMA;
 288                 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
 289                         mask &= ~(0xE0 << ATA_SHIFT_UDMA);
 290         }
 291         return mask;
 292 }
 293
 294 /**
 295  *      hpt370a_filter  -       mode selection filter
 296  *      @adev: ATA device
 297  *
 298  *      Block UDMA on devices that cause trouble with this controller.
 299  */
 300
 301 static unsigned long hpt370a_filter(struct ata_device *adev, unsigned long mask)
 302 {
 303         if (adev->class == ATA_DEV_ATA) {
 304                 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
 305                         mask &= ~(0xE0 << ATA_SHIFT_UDMA);
 306         }
 307         return mask;
 308 }
 309
 310 /**
 311  *      hpt372_filter   -       mode selection filter
 312  *      @adev: ATA device
 313  *      @mask: mode mask
 314  *
 315  *      The Marvell bridge chips used on the HighPoint SATA cards do not seem
 316  *      to support the UltraDMA modes 1, 2, and 3 as well as any MWDMA modes...
 317  */
 318 static unsigned long hpt372_filter(struct ata_device *adev, unsigned long mask)
 319 {
 320         if (ata_id_is_sata(adev->id))
 321                 mask &= ~((0xE << ATA_SHIFT_UDMA) | ATA_MASK_MWDMA);
 322
 323         return mask;
 324 }
 325
 326 /**
 327  *      hpt37x_cable_detect     -       Detect the cable type
 328  *      @ap: ATA port to detect on
 329  *
 330  *      Return the cable type attached to this port
 331  */
 332
 333 static int hpt37x_cable_detect(struct ata_port *ap)
 334 {
 335         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 336         u8 scr2, ata66;
 337
 338         pci_read_config_byte(pdev, 0x5B, &scr2);
 339         pci_write_config_byte(pdev, 0x5B, scr2 & ~0x01);
 340
 341         udelay(10); /* debounce */
 342
 343         /* Cable register now active */
 344         pci_read_config_byte(pdev, 0x5A, &ata66);
 345         /* Restore state */
 346         pci_write_config_byte(pdev, 0x5B, scr2);
 347
 348         if (ata66 & (2 >> ap->port_no))
 349                 return ATA_CBL_PATA40;
 350         else
 351                 return ATA_CBL_PATA80;
 352 }
 353
 354 /**
 355  *      hpt374_fn1_cable_detect -       Detect the cable type
 356  *      @ap: ATA port to detect on
 357  *
 358  *      Return the cable type attached to this port
 359  */
 360
 361 static int hpt374_fn1_cable_detect(struct ata_port *ap)
 362 {
 363         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 364         unsigned int mcrbase = 0x50 + 4 * ap->port_no;
 365         u16 mcr3;
 366         u8 ata66;
 367
 368         /* Do the extra channel work */
 369         pci_read_config_word(pdev, mcrbase + 2, &mcr3);
 370         /* Set bit 15 of 0x52 to enable TCBLID as input */
 371         pci_write_config_word(pdev, mcrbase + 2, mcr3 | 0x8000);
 372         pci_read_config_byte(pdev, 0x5A, &ata66);
 373         /* Reset TCBLID/FCBLID to output */
 374         pci_write_config_word(pdev, mcrbase + 2, mcr3);
 375
 376         if (ata66 & (2 >> ap->port_no))
 377                 return ATA_CBL_PATA40;
 378         else
 379                 return ATA_CBL_PATA80;
 380 }
 381
 382 /**
 383  *      hpt37x_pre_reset        -       reset the hpt37x bus
 384  *      @link: ATA link to reset
 385  *      @deadline: deadline jiffies for the operation
 386  *
 387  *      Perform the initial reset handling for the HPT37x.
 388  */
 389
 390 static int hpt37x_pre_reset(struct ata_link *link, unsigned long deadline)
 391 {
 392         struct ata_port *ap = link->ap;
 393         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 394         static const struct pci_bits hpt37x_enable_bits[] = {
 395                 { 0x50, 1, 0x04, 0x04 },
 396                 { 0x54, 1, 0x04, 0x04 }
 397         };
 398
 399         if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
 400                 return -ENOENT;
 401
 402         /* Reset the state machine */
 403         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 404         udelay(100);
 405
 406         return ata_sff_prereset(link, deadline);
 407 }
 408
 409 static void hpt370_set_mode(struct ata_port *ap, struct ata_device *adev,
 410                             u8 mode)
 411 {
 412         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 413         u32 addr1, addr2;
 414         u32 reg, timing, mask;
 415         u8 fast;
 416
 417         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 418         addr2 = 0x51 + 4 * ap->port_no;
 419
 420         /* Fast interrupt prediction disable, hold off interrupt disable */
 421         pci_read_config_byte(pdev, addr2, &fast);
 422         fast &= ~0x02;
 423         fast |= 0x01;
 424         pci_write_config_byte(pdev, addr2, fast);
 425
 426         /* Determine timing mask and find matching mode entry */
 427         if (mode < XFER_MW_DMA_0)
 428                 mask = 0xcfc3ffff;
 429         else if (mode < XFER_UDMA_0)
 430                 mask = 0x31c001ff;
 431         else
 432                 mask = 0x303c0000;
 433
 434         timing = hpt37x_find_mode(ap, mode);
 435
 436         pci_read_config_dword(pdev, addr1, &reg);
 437         reg = (reg & ~mask) | (timing & mask);
 438         pci_write_config_dword(pdev, addr1, reg);
 439 }
 440 /**
 441  *      hpt370_set_piomode              -       PIO setup
 442  *      @ap: ATA interface
 443  *      @adev: device on the interface
 444  *
 445  *      Perform PIO mode setup.
 446  */
 447
 448 static void hpt370_set_piomode(struct ata_port *ap, struct ata_device *adev)
 449 {
 450         hpt370_set_mode(ap, adev, adev->pio_mode);
 451 }
 452
 453 /**
 454  *      hpt370_set_dmamode              -       DMA timing setup
 455  *      @ap: ATA interface
 456  *      @adev: Device being configured
 457  *
 458  *      Set up the channel for MWDMA or UDMA modes.
 459  */
 460
 461 static void hpt370_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 462 {
 463         hpt370_set_mode(ap, adev, adev->dma_mode);
 464 }
 465
 466 /**
 467  *      hpt370_bmdma_end                -       DMA engine stop
 468  *      @qc: ATA command
 469  *
 470  *      Work around the HPT370 DMA engine.
 471  */
 472
 473 static void hpt370_bmdma_stop(struct ata_queued_cmd *qc)
 474 {
 475         struct ata_port *ap = qc->ap;
 476         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 477         void __iomem *bmdma = ap->ioaddr.bmdma_addr;
 478         u8 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
 479         u8 dma_cmd;
 480
 481         if (dma_stat & ATA_DMA_ACTIVE) {
 482                 udelay(20);
 483                 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
 484         }
 485         if (dma_stat & ATA_DMA_ACTIVE) {
 486                 /* Clear the engine */
 487                 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 488                 udelay(10);
 489                 /* Stop DMA */
 490                 dma_cmd = ioread8(bmdma + ATA_DMA_CMD);
 491                 iowrite8(dma_cmd & ~ATA_DMA_START, bmdma + ATA_DMA_CMD);
 492                 /* Clear Error */
 493                 dma_stat = ioread8(bmdma + ATA_DMA_STATUS);
 494                 iowrite8(dma_stat | ATA_DMA_INTR | ATA_DMA_ERR,
 495                          bmdma + ATA_DMA_STATUS);
 496                 /* Clear the engine */
 497                 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 498                 udelay(10);
 499         }
 500         ata_bmdma_stop(qc);
 501 }
 502
 503 static void hpt372_set_mode(struct ata_port *ap, struct ata_device *adev,
 504                             u8 mode)
 505 {
 506         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 507         u32 addr1, addr2;
 508         u32 reg, timing, mask;
 509         u8 fast;
 510
 511         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 512         addr2 = 0x51 + 4 * ap->port_no;
 513
 514         /* Fast interrupt prediction disable, hold off interrupt disable */
 515         pci_read_config_byte(pdev, addr2, &fast);
 516         fast &= ~0x07;
 517         pci_write_config_byte(pdev, addr2, fast);
 518
 519         /* Determine timing mask and find matching mode entry */
 520         if (mode < XFER_MW_DMA_0)
 521                 mask = 0xcfc3ffff;
 522         else if (mode < XFER_UDMA_0)
 523                 mask = 0x31c001ff;
 524         else
 525                 mask = 0x303c0000;
 526
 527         timing = hpt37x_find_mode(ap, mode);
 528
 529         pci_read_config_dword(pdev, addr1, &reg);
 530         reg = (reg & ~mask) | (timing & mask);
 531         pci_write_config_dword(pdev, addr1, reg);
 532 }
 533
 534 /**
 535  *      hpt372_set_piomode              -       PIO setup
 536  *      @ap: ATA interface
 537  *      @adev: device on the interface
 538  *
 539  *      Perform PIO mode setup.
 540  */
 541
 542 static void hpt372_set_piomode(struct ata_port *ap, struct ata_device *adev)
 543 {
 544         hpt372_set_mode(ap, adev, adev->pio_mode);
 545 }
 546
 547 /**
 548  *      hpt372_set_dmamode              -       DMA timing setup
 549  *      @ap: ATA interface
 550  *      @adev: Device being configured
 551  *
 552  *      Set up the channel for MWDMA or UDMA modes.
 553  */
 554
 555 static void hpt372_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 556 {
 557         hpt372_set_mode(ap, adev, adev->dma_mode);
 558 }
 559
 560 /**
 561  *      hpt37x_bmdma_end                -       DMA engine stop
 562  *      @qc: ATA command
 563  *
 564  *      Clean up after the HPT372 and later DMA engine
 565  */
 566
 567 static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
 568 {
 569         struct ata_port *ap = qc->ap;
 570         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 571         int mscreg = 0x50 + 4 * ap->port_no;
 572         u8 bwsr_stat, msc_stat;
 573
 574         pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
 575         pci_read_config_byte(pdev, mscreg, &msc_stat);
 576         if (bwsr_stat & (1 << ap->port_no))
 577                 pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
 578         ata_bmdma_stop(qc);
 579 }
 580
 581
 582 static struct scsi_host_template hpt37x_sht = {
 583         ATA_BMDMA_SHT(DRV_NAME),
 584 };
 585
 586 /*
 587  *      Configuration for HPT370
 588  */
 589
 590 static struct ata_port_operations hpt370_port_ops = {
 591         .inherits       = &ata_bmdma_port_ops,
 592
 593         .bmdma_stop     = hpt370_bmdma_stop,
 594
 595         .mode_filter    = hpt370_filter,
 596         .cable_detect   = hpt37x_cable_detect,
 597         .set_piomode    = hpt370_set_piomode,
 598         .set_dmamode    = hpt370_set_dmamode,
 599         .prereset       = hpt37x_pre_reset,
 600 };
 601
 602 /*
 603  *      Configuration for HPT370A. Close to 370 but less filters
 604  */
 605
 606 static struct ata_port_operations hpt370a_port_ops = {
 607         .inherits       = &hpt370_port_ops,
 608         .mode_filter    = hpt370a_filter,
 609 };
 610
 611 /*
 612  *      Configuration for HPT371 and HPT302. Slightly different PIO and DMA
 613  *      mode setting functionality.
 614  */
 615
 616 static struct ata_port_operations hpt302_port_ops = {
 617         .inherits       = &ata_bmdma_port_ops,
 618
 619         .bmdma_stop     = hpt37x_bmdma_stop,
 620
 621         .cable_detect   = hpt37x_cable_detect,
 622         .set_piomode    = hpt372_set_piomode,
 623         .set_dmamode    = hpt372_set_dmamode,
 624         .prereset       = hpt37x_pre_reset,
 625 };
 626
 627 /*
 628  *      Configuration for HPT372. Mode setting works like 371 and 302
 629  *      but we have a mode filter.
 630  */
 631
 632 static struct ata_port_operations hpt372_port_ops = {
 633         .inherits       = &hpt302_port_ops,
 634         .mode_filter    = hpt372_filter,
 635 };
 636
 637 /*
 638  *      Configuration for HPT374. Mode setting and filtering works like 372
 639  *      but we have a different cable detection procedure for function 1.
 640  */
 641
 642 static struct ata_port_operations hpt374_fn1_port_ops = {
 643         .inherits       = &hpt372_port_ops,
 644         .cable_detect   = hpt374_fn1_cable_detect,
 645         .prereset       = hpt37x_pre_reset,
 646 };
 647
 648 /**
 649  *      hpt37x_clock_slot       -       Turn timing to PC clock entry
 650  *      @freq: Reported frequency timing
 651  *      @base: Base timing
 652  *
 653  *      Turn the timing data intoa clock slot (0 for 33, 1 for 40, 2 for 50
 654  *      and 3 for 66Mhz)
 655  */
 656
 657 static int hpt37x_clock_slot(unsigned int freq, unsigned int base)
 658 {
 659         unsigned int f = (base * freq) / 192;   /* Mhz */
 660         if (f < 40)
 661                 return 0;       /* 33Mhz slot */
 662         if (f < 45)
 663                 return 1;       /* 40Mhz slot */
 664         if (f < 55)
 665                 return 2;       /* 50Mhz slot */
 666         return 3;               /* 60Mhz slot */
 667 }
 668
 669 /**
 670  *      hpt37x_calibrate_dpll           -       Calibrate the DPLL loop
 671  *      @dev: PCI device
 672  *
 673  *      Perform a calibration cycle on the HPT37x DPLL. Returns 1 if this
 674  *      succeeds
 675  */
 676
 677 static int hpt37x_calibrate_dpll(struct pci_dev *dev)
 678 {
 679         u8 reg5b;
 680         u32 reg5c;
 681         int tries;
 682
 683         for (tries = 0; tries < 0x5000; tries++) {
 684                 udelay(50);
 685                 pci_read_config_byte(dev, 0x5b, &reg5b);
 686                 if (reg5b & 0x80) {
 687                         /* See if it stays set */
 688                         for (tries = 0; tries < 0x1000; tries++) {
 689                                 pci_read_config_byte(dev, 0x5b, &reg5b);
 690                                 /* Failed ? */
 691                                 if ((reg5b & 0x80) == 0)
 692                                         return 0;
 693                         }
 694                         /* Turn off tuning, we have the DPLL set */
 695                         pci_read_config_dword(dev, 0x5c, &reg5c);
 696                         pci_write_config_dword(dev, 0x5c, reg5c & ~0x100);
 697                         return 1;
 698                 }
 699         }
 700         /* Never went stable */
 701         return 0;
 702 }
 703
 704 static u32 hpt374_read_freq(struct pci_dev *pdev)
 705 {
 706         u32 freq;
 707         unsigned long io_base = pci_resource_start(pdev, 4);
 708
 709         if (PCI_FUNC(pdev->devfn) & 1) {
 710                 struct pci_dev *pdev_0;
 711
 712                 pdev_0 = pci_get_slot(pdev->bus, pdev->devfn - 1);
 713                 /* Someone hot plugged the controller on us ? */
 714                 if (pdev_0 == NULL)
 715                         return 0;
 716                 io_base = pci_resource_start(pdev_0, 4);
 717                 freq = inl(io_base + 0x90);
 718                 pci_dev_put(pdev_0);
 719         } else
 720                 freq = inl(io_base + 0x90);
 721         return freq;
 722 }
 723
 724 /**
 725  *      hpt37x_init_one         -       Initialise an HPT37X/302
 726  *      @dev: PCI device
 727  *      @id: Entry in match table
 728  *
 729  *      Initialise an HPT37x device. There are some interesting complications
 730  *      here. Firstly the chip may report 366 and be one of several variants.
 731  *      Secondly all the timings depend on the clock for the chip which we must
 732  *      detect and look up
 733  *
 734  *      This is the known chip mappings. It may be missing a couple of later
 735  *      releases.
 736  *
 737  *      Chip version            PCI             Rev     Notes
 738  *      HPT366                  4 (HPT366)      0       Other driver
 739  *      HPT366                  4 (HPT366)      1       Other driver
 740  *      HPT368                  4 (HPT366)      2       Other driver
 741  *      HPT370                  4 (HPT366)      3       UDMA100
 742  *      HPT370A                 4 (HPT366)      4       UDMA100
 743  *      HPT372                  4 (HPT366)      5       UDMA133 (1)
 744  *      HPT372N                 4 (HPT366)      6       Other driver
 745  *      HPT372A                 5 (HPT372)      1       UDMA133 (1)
 746  *      HPT372N                 5 (HPT372)      2       Other driver
 747  *      HPT302                  6 (HPT302)      1       UDMA133
 748  *      HPT302N                 6 (HPT302)      2       Other driver
 749  *      HPT371                  7 (HPT371)      *       UDMA133
 750  *      HPT374                  8 (HPT374)      *       UDMA133 4 channel
 751  *      HPT372N                 9 (HPT372N)     *       Other driver
 752  *
 753  *      (1) UDMA133 support depends on the bus clock
 754  */
 755
 756 static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
 757 {
 758         /* HPT370 - UDMA100 */
 759         static const struct ata_port_info info_hpt370 = {
 760                 .flags = ATA_FLAG_SLAVE_POSS,
 761                 .pio_mask = ATA_PIO4,
 762                 .mwdma_mask = ATA_MWDMA2,
 763                 .udma_mask = ATA_UDMA5,
 764                 .port_ops = &hpt370_port_ops
 765         };
 766         /* HPT370A - UDMA100 */
 767         static const struct ata_port_info info_hpt370a = {
 768                 .flags = ATA_FLAG_SLAVE_POSS,
 769                 .pio_mask = ATA_PIO4,
 770                 .mwdma_mask = ATA_MWDMA2,
 771                 .udma_mask = ATA_UDMA5,
 772                 .port_ops = &hpt370a_port_ops
 773         };
 774         /* HPT370 - UDMA66 */
 775         static const struct ata_port_info info_hpt370_33 = {
 776                 .flags = ATA_FLAG_SLAVE_POSS,
 777                 .pio_mask = ATA_PIO4,
 778                 .mwdma_mask = ATA_MWDMA2,
 779                 .udma_mask = ATA_UDMA4,
 780                 .port_ops = &hpt370_port_ops
 781         };
 782         /* HPT370A - UDMA66 */
 783         static const struct ata_port_info info_hpt370a_33 = {
 784                 .flags = ATA_FLAG_SLAVE_POSS,
 785                 .pio_mask = ATA_PIO4,
 786                 .mwdma_mask = ATA_MWDMA2,
 787                 .udma_mask = ATA_UDMA4,
 788                 .port_ops = &hpt370a_port_ops
 789         };
 790         /* HPT372 - UDMA133 */
 791         static const struct ata_port_info info_hpt372 = {
 792                 .flags = ATA_FLAG_SLAVE_POSS,
 793                 .pio_mask = ATA_PIO4,
 794                 .mwdma_mask = ATA_MWDMA2,
 795                 .udma_mask = ATA_UDMA6,
 796                 .port_ops = &hpt372_port_ops
 797         };
 798         /* HPT371, 302 - UDMA133 */
 799         static const struct ata_port_info info_hpt302 = {
 800                 .flags = ATA_FLAG_SLAVE_POSS,
 801                 .pio_mask = ATA_PIO4,
 802                 .mwdma_mask = ATA_MWDMA2,
 803                 .udma_mask = ATA_UDMA6,
 804                 .port_ops = &hpt302_port_ops
 805         };
 806         /* HPT374 - UDMA100, function 1 uses different prereset method */
 807         static const struct ata_port_info info_hpt374_fn0 = {
 808                 .flags = ATA_FLAG_SLAVE_POSS,
 809                 .pio_mask = ATA_PIO4,
 810                 .mwdma_mask = ATA_MWDMA2,
 811                 .udma_mask = ATA_UDMA5,
 812                 .port_ops = &hpt372_port_ops
 813         };
 814         static const struct ata_port_info info_hpt374_fn1 = {
 815                 .flags = ATA_FLAG_SLAVE_POSS,
 816                 .pio_mask = ATA_PIO4,
 817                 .mwdma_mask = ATA_MWDMA2,
 818                 .udma_mask = ATA_UDMA5,
 819                 .port_ops = &hpt374_fn1_port_ops
 820         };
 821
 822         static const int MHz[4] = { 33, 40, 50, 66 };
 823         void *private_data = NULL;
 824         const struct ata_port_info *ppi[] = { NULL, NULL };
 825         u8 rev = dev->revision;
 826         u8 irqmask;
 827         u8 mcr1;
 828         u32 freq;
 829         int prefer_dpll = 1;
 830
 831         unsigned long iobase = pci_resource_start(dev, 4);
 832
 833         const struct hpt_chip *chip_table;
 834         int clock_slot;
 835         int rc;
 836
 837         rc = pcim_enable_device(dev);
 838         if (rc)
 839                 return rc;
 840
 841         if (dev->device == PCI_DEVICE_ID_TTI_HPT366) {
 842                 /* May be a later chip in disguise. Check */
 843                 /* Older chips are in the HPT366 driver. Ignore them */
 844                 if (rev < 3)
 845                         return -ENODEV;
 846                 /* N series chips have their own driver. Ignore */
 847                 if (rev == 6)
 848                         return -ENODEV;
 849
 850                 switch (rev) {
 851                 case 3:
 852                         ppi[0] = &info_hpt370;
 853                         chip_table = &hpt370;
 854                         prefer_dpll = 0;
 855                         break;
 856                 case 4:
 857                         ppi[0] = &info_hpt370a;
 858                         chip_table = &hpt370a;
 859                         prefer_dpll = 0;
 860                         break;
 861                 case 5:
 862                         ppi[0] = &info_hpt372;
 863                         chip_table = &hpt372;
 864                         break;
 865                 default:
 866                         printk(KERN_ERR "pata_hpt37x: Unknown HPT366 subtype, "
 867                                "please report (%d).\n", rev);
 868                         return -ENODEV;
 869                 }
 870         } else {
 871                 switch (dev->device) {
 872                 case PCI_DEVICE_ID_TTI_HPT372:
 873                         /* 372N if rev >= 2 */
 874                         if (rev >= 2)
 875                                 return -ENODEV;
 876                         ppi[0] = &info_hpt372;
 877                         chip_table = &hpt372a;
 878                         break;
 879                 case PCI_DEVICE_ID_TTI_HPT302:
 880                         /* 302N if rev > 1 */
 881                         if (rev > 1)
 882                                 return -ENODEV;
 883                         ppi[0] = &info_hpt302;
 884                         /* Check this */
 885                         chip_table = &hpt302;
 886                         break;
 887                 case PCI_DEVICE_ID_TTI_HPT371:
 888                         if (rev > 1)
 889                                 return -ENODEV;
 890                         ppi[0] = &info_hpt302;
 891                         chip_table = &hpt371;
 892                         /*
 893                          * Single channel device, master is not present
 894                          * but the BIOS (or us for non x86) must mark it
 895                          * absent
 896                          */
 897                         pci_read_config_byte(dev, 0x50, &mcr1);
 898                         mcr1 &= ~0x04;
 899                         pci_write_config_byte(dev, 0x50, mcr1);
 900                         break;
 901                 case PCI_DEVICE_ID_TTI_HPT374:
 902                         chip_table = &hpt374;
 903                         if (!(PCI_FUNC(dev->devfn) & 1))
 904                                 *ppi = &info_hpt374_fn0;
 905                         else
 906                                 *ppi = &info_hpt374_fn1;
 907                         break;
 908                 default:
 909                         printk(KERN_ERR
 910                                "pata_hpt37x: PCI table is bogus, please report (%d).\n",
 911                                dev->device);
 912                                 return -ENODEV;
 913                 }
 914         }
 915         /* Ok so this is a chip we support */
 916
 917         pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
 918         pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
 919         pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
 920         pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
 921
 922         pci_read_config_byte(dev, 0x5A, &irqmask);
 923         irqmask &= ~0x10;
 924         pci_write_config_byte(dev, 0x5a, irqmask);
 925
 926         /*
 927          * default to pci clock. make sure MA15/16 are set to output
 928          * to prevent drives having problems with 40-pin cables. Needed
 929          * for some drives such as IBM-DTLA which will not enter ready
 930          * state on reset when PDIAG is a input.
 931          */
 932
 933         pci_write_config_byte(dev, 0x5b, 0x23);
 934
 935         /*
 936          * HighPoint does this for HPT372A.
 937          * NOTE: This register is only writeable via I/O space.
 938          */
 939         if (chip_table == &hpt372a)
 940                 outb(0x0e, iobase + 0x9c);
 941
 942         /*
 943          * Some devices do not let this value be accessed via PCI space
 944          * according to the old driver. In addition we must use the value
 945          * from FN 0 on the HPT374.
 946          */
 947
 948         if (chip_table == &hpt374) {
 949                 freq = hpt374_read_freq(dev);
 950                 if (freq == 0)
 951                         return -ENODEV;
 952         } else
 953                 freq = inl(iobase + 0x90);
 954
 955         if ((freq >> 12) != 0xABCDE) {
 956                 int i;
 957                 u8 sr;
 958                 u32 total = 0;
 959
 960                 printk(KERN_WARNING
 961                        "pata_hpt37x: BIOS has not set timing clocks.\n");
 962
 963                 /* This is the process the HPT371 BIOS is reported to use */
 964                 for (i = 0; i < 128; i++) {
 965                         pci_read_config_byte(dev, 0x78, &sr);
 966                         total += sr & 0x1FF;
 967                         udelay(15);
 968                 }
 969                 freq = total / 128;
 970         }
 971         freq &= 0x1FF;
 972
 973         /*
 974          *      Turn the frequency check into a band and then find a timing
 975          *      table to match it.
 976          */
 977
 978         clock_slot = hpt37x_clock_slot(freq, chip_table->base);
 979         if (chip_table->clocks[clock_slot] == NULL || prefer_dpll) {
 980                 /*
 981                  *      We need to try PLL mode instead
 982                  *
 983                  *      For non UDMA133 capable devices we should
 984                  *      use a 50MHz DPLL by choice
 985                  */
 986                 unsigned int f_low, f_high;
 987                 int dpll, adjust;
 988
 989                 /* Compute DPLL */
 990                 dpll = (ppi[0]->udma_mask & 0xC0) ? 3 : 2;
 991
 992                 f_low = (MHz[clock_slot] * 48) / MHz[dpll];
 993                 f_high = f_low + 2;
 994                 if (clock_slot > 1)
 995                         f_high += 2;
 996
 997                 /* Select the DPLL clock. */
 998                 pci_write_config_byte(dev, 0x5b, 0x21);
 999                 pci_write_config_dword(dev, 0x5C,
1000                                        (f_high << 16) | f_low | 0x100);
1001
1002                 for (adjust = 0; adjust < 8; adjust++) {
1003                         if (hpt37x_calibrate_dpll(dev))
1004                                 break;
1005                         /*
1006                          * See if it'll settle at a fractionally
1007                          * different clock
1008                          */
1009                         if (adjust & 1)
1010                                 f_low -= adjust >> 1;
1011                         else
1012                                 f_high += adjust >> 1;
1013                         pci_write_config_dword(dev, 0x5C,
1014                                                (f_high << 16) | f_low | 0x100);
1015                 }
1016                 if (adjust == 8) {
1017                         printk(KERN_ERR "pata_hpt37x: DPLL did not stabilize!\n");
1018                         return -ENODEV;
1019                 }
1020                 if (dpll == 3)
1021                         private_data = (void *)hpt37x_timings_66;
1022                 else
1023                         private_data = (void *)hpt37x_timings_50;
1024
1025                 printk(KERN_INFO "pata_hpt37x: bus clock %dMHz, using %dMHz DPLL.\n",
1026                        MHz[clock_slot], MHz[dpll]);
1027         } else {
1028                 private_data = (void *)chip_table->clocks[clock_slot];
1029                 /*
1030                  *      Perform a final fixup. Note that we will have used the
1031                  *      DPLL on the HPT372 which means we don't have to worry
1032                  *      about lack of UDMA133 support on lower clocks
1033                  */
1034
1035                 if (clock_slot < 2 && ppi[0] == &info_hpt370)
1036                         ppi[0] = &info_hpt370_33;
1037                 if (clock_slot < 2 && ppi[0] == &info_hpt370a)
1038                         ppi[0] = &info_hpt370a_33;
1039                 printk(KERN_INFO "pata_hpt37x: %s using %dMHz bus clock.\n",
1040                        chip_table->name, MHz[clock_slot]);
1041         }
1042
1043         /* Now kick off ATA set up */
1044         return ata_pci_bmdma_init_one(dev, ppi, &hpt37x_sht, private_data, 0);
1045 }
1046
1047 static const struct pci_device_id hpt37x[] = {
1048         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT366), },
1049         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT371), },
1050         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT372), },
1051         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT374), },
1052         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT302), },
1053
1054         { },
1055 };
1056
1057 static struct pci_driver hpt37x_pci_driver = {
1058         .name           = DRV_NAME,
1059         .id_table       = hpt37x,
1060         .probe          = hpt37x_init_one,
1061         .remove         = ata_pci_remove_one
1062 };
1063
1064 static int __init hpt37x_init(void)
1065 {
1066         return pci_register_driver(&hpt37x_pci_driver);
1067 }
1068
1069 static void __exit hpt37x_exit(void)
1070 {
1071         pci_unregister_driver(&hpt37x_pci_driver);
1072 }
1073
1074 MODULE_AUTHOR("Alan Cox");
1075 MODULE_DESCRIPTION("low-level driver for the Highpoint HPT37x/30x");
1076 MODULE_LICENSE("GPL");
1077 MODULE_DEVICE_TABLE(pci, hpt37x);
1078 MODULE_VERSION(DRV_VERSION);
1079
1080 module_init(hpt37x_init);
1081 module_exit(hpt37x_exit);