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