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  *
  12  * TODO
  13  *      PLL mode
  14  *      Look into engine reset on timeout errors. Should not be
  15  *              required.
  16  */
  17
  18 #include <linux/kernel.h>
  19 #include <linux/module.h>
  20 #include <linux/pci.h>
  21 #include <linux/init.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.5.1"
  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
  44  *        DMA. cycles = value + 1
  45  * 4:8    data_low_time. active time of DIOW_/DIOR_ for PIO and MW
  46  *        DMA. 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:21  udma_cycle_time. clock freq and clock cycles for UDMA xfer.
  52  *        during task file register access.
  53  * 22:24  pre_high_time. time to initialize 1st cycle for PIO and MW DMA
  54  *        xfer.
  55  * 25:27  cmd_pre_high_time. time to initialize 1st PIO cycle for task
  56  *        register access.
  57  * 28     UDMA enable
  58  * 29     DMA enable
  59  * 30     PIO_MST enable. if set, the chip is in bus master mode during
  60  *        PIO.
  61  * 31     FIFO enable.
  62  */
  63
  64 /* from highpoint documentation. these are old values */
  65 static const struct hpt_clock hpt370_timings_33[] = {
  66 /*      {       XFER_UDMA_5,    0x1A85F442,     0x16454e31      }, */
  67         {       XFER_UDMA_5,    0x16454e31      },
  68         {       XFER_UDMA_4,    0x16454e31      },
  69         {       XFER_UDMA_3,    0x166d4e31      },
  70         {       XFER_UDMA_2,    0x16494e31      },
  71         {       XFER_UDMA_1,    0x164d4e31      },
  72         {       XFER_UDMA_0,    0x16514e31      },
  73
  74         {       XFER_MW_DMA_2,  0x26514e21      },
  75         {       XFER_MW_DMA_1,  0x26514e33      },
  76         {       XFER_MW_DMA_0,  0x26514e97      },
  77
  78         {       XFER_PIO_4,     0x06514e21      },
  79         {       XFER_PIO_3,     0x06514e22      },
  80         {       XFER_PIO_2,     0x06514e33      },
  81         {       XFER_PIO_1,     0x06914e43      },
  82         {       XFER_PIO_0,     0x06914e57      },
  83         {       0,              0x06514e57      }
  84 };
  85
  86 static const struct hpt_clock hpt370_timings_66[] = {
  87         {       XFER_UDMA_5,    0x14846231      },
  88         {       XFER_UDMA_4,    0x14886231      },
  89         {       XFER_UDMA_3,    0x148c6231      },
  90         {       XFER_UDMA_2,    0x148c6231      },
  91         {       XFER_UDMA_1,    0x14906231      },
  92         {       XFER_UDMA_0,    0x14986231      },
  93
  94         {       XFER_MW_DMA_2,  0x26514e21      },
  95         {       XFER_MW_DMA_1,  0x26514e33      },
  96         {       XFER_MW_DMA_0,  0x26514e97      },
  97
  98         {       XFER_PIO_4,     0x06514e21      },
  99         {       XFER_PIO_3,     0x06514e22      },
 100         {       XFER_PIO_2,     0x06514e33      },
 101         {       XFER_PIO_1,     0x06914e43      },
 102         {       XFER_PIO_0,     0x06914e57      },
 103         {       0,              0x06514e57      }
 104 };
 105
 106 /* these are the current (4 sep 2001) timings from highpoint */
 107 static const struct hpt_clock hpt370a_timings_33[] = {
 108         {       XFER_UDMA_5,    0x12446231      },
 109         {       XFER_UDMA_4,    0x12446231      },
 110         {       XFER_UDMA_3,    0x126c6231      },
 111         {       XFER_UDMA_2,    0x12486231      },
 112         {       XFER_UDMA_1,    0x124c6233      },
 113         {       XFER_UDMA_0,    0x12506297      },
 114
 115         {       XFER_MW_DMA_2,  0x22406c31      },
 116         {       XFER_MW_DMA_1,  0x22406c33      },
 117         {       XFER_MW_DMA_0,  0x22406c97      },
 118
 119         {       XFER_PIO_4,     0x06414e31      },
 120         {       XFER_PIO_3,     0x06414e42      },
 121         {       XFER_PIO_2,     0x06414e53      },
 122         {       XFER_PIO_1,     0x06814e93      },
 123         {       XFER_PIO_0,     0x06814ea7      },
 124         {       0,              0x06814ea7      }
 125 };
 126
 127 /* 2x 33MHz timings */
 128 static const struct hpt_clock hpt370a_timings_66[] = {
 129         {       XFER_UDMA_5,    0x1488e673      },
 130         {       XFER_UDMA_4,    0x1488e673      },
 131         {       XFER_UDMA_3,    0x1498e673      },
 132         {       XFER_UDMA_2,    0x1490e673      },
 133         {       XFER_UDMA_1,    0x1498e677      },
 134         {       XFER_UDMA_0,    0x14a0e73f      },
 135
 136         {       XFER_MW_DMA_2,  0x2480fa73      },
 137         {       XFER_MW_DMA_1,  0x2480fa77      },
 138         {       XFER_MW_DMA_0,  0x2480fb3f      },
 139
 140         {       XFER_PIO_4,     0x0c82be73      },
 141         {       XFER_PIO_3,     0x0c82be95      },
 142         {       XFER_PIO_2,     0x0c82beb7      },
 143         {       XFER_PIO_1,     0x0d02bf37      },
 144         {       XFER_PIO_0,     0x0d02bf5f      },
 145         {       0,              0x0d02bf5f      }
 146 };
 147
 148 static const struct hpt_clock hpt370a_timings_50[] = {
 149         {       XFER_UDMA_5,    0x12848242      },
 150         {       XFER_UDMA_4,    0x12ac8242      },
 151         {       XFER_UDMA_3,    0x128c8242      },
 152         {       XFER_UDMA_2,    0x120c8242      },
 153         {       XFER_UDMA_1,    0x12148254      },
 154         {       XFER_UDMA_0,    0x121882ea      },
 155
 156         {       XFER_MW_DMA_2,  0x22808242      },
 157         {       XFER_MW_DMA_1,  0x22808254      },
 158         {       XFER_MW_DMA_0,  0x228082ea      },
 159
 160         {       XFER_PIO_4,     0x0a81f442      },
 161         {       XFER_PIO_3,     0x0a81f443      },
 162         {       XFER_PIO_2,     0x0a81f454      },
 163         {       XFER_PIO_1,     0x0ac1f465      },
 164         {       XFER_PIO_0,     0x0ac1f48a      },
 165         {       0,              0x0ac1f48a      }
 166 };
 167
 168 static const struct hpt_clock hpt372_timings_33[] = {
 169         {       XFER_UDMA_6,    0x1c81dc62      },
 170         {       XFER_UDMA_5,    0x1c6ddc62      },
 171         {       XFER_UDMA_4,    0x1c8ddc62      },
 172         {       XFER_UDMA_3,    0x1c8edc62      },      /* checkme */
 173         {       XFER_UDMA_2,    0x1c91dc62      },
 174         {       XFER_UDMA_1,    0x1c9adc62      },      /* checkme */
 175         {       XFER_UDMA_0,    0x1c82dc62      },      /* checkme */
 176
 177         {       XFER_MW_DMA_2,  0x2c829262      },
 178         {       XFER_MW_DMA_1,  0x2c829266      },      /* checkme */
 179         {       XFER_MW_DMA_0,  0x2c82922e      },      /* checkme */
 180
 181         {       XFER_PIO_4,     0x0c829c62      },
 182         {       XFER_PIO_3,     0x0c829c84      },
 183         {       XFER_PIO_2,     0x0c829ca6      },
 184         {       XFER_PIO_1,     0x0d029d26      },
 185         {       XFER_PIO_0,     0x0d029d5e      },
 186         {       0,              0x0d029d5e      }
 187 };
 188
 189 static const struct hpt_clock hpt372_timings_50[] = {
 190         {       XFER_UDMA_5,    0x12848242      },
 191         {       XFER_UDMA_4,    0x12ac8242      },
 192         {       XFER_UDMA_3,    0x128c8242      },
 193         {       XFER_UDMA_2,    0x120c8242      },
 194         {       XFER_UDMA_1,    0x12148254      },
 195         {       XFER_UDMA_0,    0x121882ea      },
 196
 197         {       XFER_MW_DMA_2,  0x22808242      },
 198         {       XFER_MW_DMA_1,  0x22808254      },
 199         {       XFER_MW_DMA_0,  0x228082ea      },
 200
 201         {       XFER_PIO_4,     0x0a81f442      },
 202         {       XFER_PIO_3,     0x0a81f443      },
 203         {       XFER_PIO_2,     0x0a81f454      },
 204         {       XFER_PIO_1,     0x0ac1f465      },
 205         {       XFER_PIO_0,     0x0ac1f48a      },
 206         {       0,              0x0a81f443      }
 207 };
 208
 209 static const struct hpt_clock hpt372_timings_66[] = {
 210         {       XFER_UDMA_6,    0x1c869c62      },
 211         {       XFER_UDMA_5,    0x1cae9c62      },
 212         {       XFER_UDMA_4,    0x1c8a9c62      },
 213         {       XFER_UDMA_3,    0x1c8e9c62      },
 214         {       XFER_UDMA_2,    0x1c929c62      },
 215         {       XFER_UDMA_1,    0x1c9a9c62      },
 216         {       XFER_UDMA_0,    0x1c829c62      },
 217
 218         {       XFER_MW_DMA_2,  0x2c829c62      },
 219         {       XFER_MW_DMA_1,  0x2c829c66      },
 220         {       XFER_MW_DMA_0,  0x2c829d2e      },
 221
 222         {       XFER_PIO_4,     0x0c829c62      },
 223         {       XFER_PIO_3,     0x0c829c84      },
 224         {       XFER_PIO_2,     0x0c829ca6      },
 225         {       XFER_PIO_1,     0x0d029d26      },
 226         {       XFER_PIO_0,     0x0d029d5e      },
 227         {       0,              0x0d029d26      }
 228 };
 229
 230 static const struct hpt_clock hpt374_timings_33[] = {
 231         {       XFER_UDMA_6,    0x12808242      },
 232         {       XFER_UDMA_5,    0x12848242      },
 233         {       XFER_UDMA_4,    0x12ac8242      },
 234         {       XFER_UDMA_3,    0x128c8242      },
 235         {       XFER_UDMA_2,    0x120c8242      },
 236         {       XFER_UDMA_1,    0x12148254      },
 237         {       XFER_UDMA_0,    0x121882ea      },
 238
 239         {       XFER_MW_DMA_2,  0x22808242      },
 240         {       XFER_MW_DMA_1,  0x22808254      },
 241         {       XFER_MW_DMA_0,  0x228082ea      },
 242
 243         {       XFER_PIO_4,     0x0a81f442      },
 244         {       XFER_PIO_3,     0x0a81f443      },
 245         {       XFER_PIO_2,     0x0a81f454      },
 246         {       XFER_PIO_1,     0x0ac1f465      },
 247         {       XFER_PIO_0,     0x0ac1f48a      },
 248         {       0,              0x06814e93      }
 249 };
 250
 251 static const struct hpt_chip hpt370 = {
 252         "HPT370",
 253         48,
 254         {
 255                 hpt370_timings_33,
 256                 NULL,
 257                 NULL,
 258                 hpt370_timings_66
 259         }
 260 };
 261
 262 static const struct hpt_chip hpt370a = {
 263         "HPT370A",
 264         48,
 265         {
 266                 hpt370a_timings_33,
 267                 NULL,
 268                 hpt370a_timings_50,
 269                 hpt370a_timings_66
 270         }
 271 };
 272
 273 static const struct hpt_chip hpt372 = {
 274         "HPT372",
 275         55,
 276         {
 277                 hpt372_timings_33,
 278                 NULL,
 279                 hpt372_timings_50,
 280                 hpt372_timings_66
 281         }
 282 };
 283
 284 static const struct hpt_chip hpt302 = {
 285         "HPT302",
 286         66,
 287         {
 288                 hpt372_timings_33,
 289                 NULL,
 290                 hpt372_timings_50,
 291                 hpt372_timings_66
 292         }
 293 };
 294
 295 static const struct hpt_chip hpt371 = {
 296         "HPT371",
 297         66,
 298         {
 299                 hpt372_timings_33,
 300                 NULL,
 301                 hpt372_timings_50,
 302                 hpt372_timings_66
 303         }
 304 };
 305
 306 static const struct hpt_chip hpt372a = {
 307         "HPT372A",
 308         66,
 309         {
 310                 hpt372_timings_33,
 311                 NULL,
 312                 hpt372_timings_50,
 313                 hpt372_timings_66
 314         }
 315 };
 316
 317 static const struct hpt_chip hpt374 = {
 318         "HPT374",
 319         48,
 320         {
 321                 hpt374_timings_33,
 322                 NULL,
 323                 NULL,
 324                 NULL
 325         }
 326 };
 327
 328 /**
 329  *      hpt37x_find_mode        -       reset the hpt37x bus
 330  *      @ap: ATA port
 331  *      @speed: transfer mode
 332  *
 333  *      Return the 32bit register programming information for this channel
 334  *      that matches the speed provided.
 335  */
 336
 337 static u32 hpt37x_find_mode(struct ata_port *ap, int speed)
 338 {
 339         struct hpt_clock *clocks = ap->host->private_data;
 340
 341         while(clocks->xfer_speed) {
 342                 if (clocks->xfer_speed == speed)
 343                         return clocks->timing;
 344                 clocks++;
 345         }
 346         BUG();
 347         return 0xffffffffU;     /* silence compiler warning */
 348 }
 349
 350 static int hpt_dma_blacklisted(const struct ata_device *dev, char *modestr, const char *list[])
 351 {
 352         unsigned char model_num[40];
 353         char *s;
 354         unsigned int len;
 355         int i = 0;
 356
 357         ata_id_string(dev->id, model_num, ATA_ID_PROD_OFS,
 358                           sizeof(model_num));
 359         s = &model_num[0];
 360         len = strnlen(s, sizeof(model_num));
 361
 362         /* ATAPI specifies that empty space is blank-filled; remove blanks */
 363         while ((len > 0) && (s[len - 1] == ' ')) {
 364                 len--;
 365                 s[len] = 0;
 366         }
 367
 368         while(list[i] != NULL) {
 369                 if (!strncmp(list[i], s, len)) {
 370                         printk(KERN_WARNING DRV_NAME ": %s is not supported for %s.\n",
 371                                 modestr, list[i]);
 372                         return 1;
 373                 }
 374                 i++;
 375         }
 376         return 0;
 377 }
 378
 379 static const char *bad_ata33[] = {
 380         "Maxtor 92720U8", "Maxtor 92040U6", "Maxtor 91360U4", "Maxtor 91020U3", "Maxtor 90845U3", "Maxtor 90650U2",
 381         "Maxtor 91360D8", "Maxtor 91190D7", "Maxtor 91020D6", "Maxtor 90845D5", "Maxtor 90680D4", "Maxtor 90510D3", "Maxtor 90340D2",
 382         "Maxtor 91152D8", "Maxtor 91008D7", "Maxtor 90845D6", "Maxtor 90840D6", "Maxtor 90720D5", "Maxtor 90648D5", "Maxtor 90576D4",
 383         "Maxtor 90510D4",
 384         "Maxtor 90432D3", "Maxtor 90288D2", "Maxtor 90256D2",
 385         "Maxtor 91000D8", "Maxtor 90910D8", "Maxtor 90875D7", "Maxtor 90840D7", "Maxtor 90750D6", "Maxtor 90625D5", "Maxtor 90500D4",
 386         "Maxtor 91728D8", "Maxtor 91512D7", "Maxtor 91303D6", "Maxtor 91080D5", "Maxtor 90845D4", "Maxtor 90680D4", "Maxtor 90648D3", "Maxtor 90432D2",
 387         NULL
 388 };
 389
 390 static const char *bad_ata100_5[] = {
 391         "IBM-DTLA-307075",
 392         "IBM-DTLA-307060",
 393         "IBM-DTLA-307045",
 394         "IBM-DTLA-307030",
 395         "IBM-DTLA-307020",
 396         "IBM-DTLA-307015",
 397         "IBM-DTLA-305040",
 398         "IBM-DTLA-305030",
 399         "IBM-DTLA-305020",
 400         "IC35L010AVER07-0",
 401         "IC35L020AVER07-0",
 402         "IC35L030AVER07-0",
 403         "IC35L040AVER07-0",
 404         "IC35L060AVER07-0",
 405         "WDC AC310200R",
 406         NULL
 407 };
 408
 409 /**
 410  *      hpt370_filter   -       mode selection filter
 411  *      @ap: ATA interface
 412  *      @adev: ATA device
 413  *
 414  *      Block UDMA on devices that cause trouble with this controller.
 415  */
 416
 417 static unsigned long hpt370_filter(const struct ata_port *ap, struct ata_device *adev, unsigned long mask)
 418 {
 419         if (adev->class != ATA_DEV_ATA) {
 420                 if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33))
 421                         mask &= ~ATA_MASK_UDMA;
 422                 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
 423                         mask &= ~(0x1F << ATA_SHIFT_UDMA);
 424         }
 425         return ata_pci_default_filter(ap, adev, mask);
 426 }
 427
 428 /**
 429  *      hpt370a_filter  -       mode selection filter
 430  *      @ap: ATA interface
 431  *      @adev: ATA device
 432  *
 433  *      Block UDMA on devices that cause trouble with this controller.
 434  */
 435
 436 static unsigned long hpt370a_filter(const struct ata_port *ap, struct ata_device *adev, unsigned long mask)
 437 {
 438         if (adev->class != ATA_DEV_ATA) {
 439                 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
 440                         mask &= ~ (0x1F << ATA_SHIFT_UDMA);
 441         }
 442         return ata_pci_default_filter(ap, adev, mask);
 443 }
 444
 445 /**
 446  *      hpt37x_pre_reset        -       reset the hpt37x bus
 447  *      @ap: ATA port to reset
 448  *
 449  *      Perform the initial reset handling for the 370/372 and 374 func 0
 450  */
 451
 452 static int hpt37x_pre_reset(struct ata_port *ap)
 453 {
 454         u8 scr2, ata66;
 455         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 456         static const struct pci_bits hpt37x_enable_bits[] = {
 457                 { 0x50, 1, 0x04, 0x04 },
 458                 { 0x54, 1, 0x04, 0x04 }
 459         };
 460         if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
 461                 return -ENOENT;
 462
 463         pci_read_config_byte(pdev, 0x5B, &scr2);
 464         pci_write_config_byte(pdev, 0x5B, scr2 & ~0x01);
 465         /* Cable register now active */
 466         pci_read_config_byte(pdev, 0x5A, &ata66);
 467         /* Restore state */
 468         pci_write_config_byte(pdev, 0x5B, scr2);
 469
 470         if (ata66 & (1 << ap->port_no))
 471                 ap->cbl = ATA_CBL_PATA40;
 472         else
 473                 ap->cbl = ATA_CBL_PATA80;
 474
 475         /* Reset the state machine */
 476         pci_write_config_byte(pdev, 0x50, 0x37);
 477         pci_write_config_byte(pdev, 0x54, 0x37);
 478         udelay(100);
 479
 480         return ata_std_prereset(ap);
 481 }
 482
 483 /**
 484  *      hpt37x_error_handler    -       reset the hpt374
 485  *      @ap: ATA port to reset
 486  *
 487  *      Perform probe for HPT37x, except for HPT374 channel 2
 488  */
 489
 490 static void hpt37x_error_handler(struct ata_port *ap)
 491 {
 492         ata_bmdma_drive_eh(ap, hpt37x_pre_reset, ata_std_softreset, NULL, ata_std_postreset);
 493 }
 494
 495 static int hpt374_pre_reset(struct ata_port *ap)
 496 {
 497         static const struct pci_bits hpt37x_enable_bits[] = {
 498                 { 0x50, 1, 0x04, 0x04 },
 499                 { 0x54, 1, 0x04, 0x04 }
 500         };
 501         u16 mcr3, mcr6;
 502         u8 ata66;
 503         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 504
 505         if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
 506                 return -ENOENT;
 507
 508         /* Do the extra channel work */
 509         pci_read_config_word(pdev, 0x52, &mcr3);
 510         pci_read_config_word(pdev, 0x56, &mcr6);
 511         /* Set bit 15 of 0x52 to enable TCBLID as input
 512            Set bit 15 of 0x56 to enable FCBLID as input
 513          */
 514         pci_write_config_word(pdev, 0x52, mcr3 | 0x8000);
 515         pci_write_config_word(pdev, 0x56, mcr6 | 0x8000);
 516         pci_read_config_byte(pdev, 0x5A, &ata66);
 517         /* Reset TCBLID/FCBLID to output */
 518         pci_write_config_word(pdev, 0x52, mcr3);
 519         pci_write_config_word(pdev, 0x56, mcr6);
 520
 521         if (ata66 & (1 << ap->port_no))
 522                 ap->cbl = ATA_CBL_PATA40;
 523         else
 524                 ap->cbl = ATA_CBL_PATA80;
 525
 526         /* Reset the state machine */
 527         pci_write_config_byte(pdev, 0x50, 0x37);
 528         pci_write_config_byte(pdev, 0x54, 0x37);
 529         udelay(100);
 530
 531         return ata_std_prereset(ap);
 532 }
 533
 534 /**
 535  *      hpt374_error_handler    -       reset the hpt374
 536  *      @classes:
 537  *
 538  *      The 374 cable detect is a little different due to the extra
 539  *      channels. The function 0 channels work like usual but function 1
 540  *      is special
 541  */
 542
 543 static void hpt374_error_handler(struct ata_port *ap)
 544 {
 545         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 546
 547         if (!(PCI_FUNC(pdev->devfn) & 1))
 548                 hpt37x_error_handler(ap);
 549         else
 550                 ata_bmdma_drive_eh(ap, hpt374_pre_reset, ata_std_softreset, NULL, ata_std_postreset);
 551 }
 552
 553 /**
 554  *      hpt370_set_piomode              -       PIO setup
 555  *      @ap: ATA interface
 556  *      @adev: device on the interface
 557  *
 558  *      Perform PIO mode setup.
 559  */
 560
 561 static void hpt370_set_piomode(struct ata_port *ap, struct ata_device *adev)
 562 {
 563         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 564         u32 addr1, addr2;
 565         u32 reg;
 566         u32 mode;
 567         u8 fast;
 568
 569         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 570         addr2 = 0x51 + 4 * ap->port_no;
 571
 572         /* Fast interrupt prediction disable, hold off interrupt disable */
 573         pci_read_config_byte(pdev, addr2, &fast);
 574         fast &= ~0x02;
 575         fast |= 0x01;
 576         pci_write_config_byte(pdev, addr2, fast);
 577
 578         pci_read_config_dword(pdev, addr1, &reg);
 579         mode = hpt37x_find_mode(ap, adev->pio_mode);
 580         mode &= ~0x8000000;     /* No FIFO in PIO */
 581         mode &= ~0x30070000;    /* Leave config bits alone */
 582         reg &= 0x30070000;      /* Strip timing bits */
 583         pci_write_config_dword(pdev, addr1, reg | mode);
 584 }
 585
 586 /**
 587  *      hpt370_set_dmamode              -       DMA timing setup
 588  *      @ap: ATA interface
 589  *      @adev: Device being configured
 590  *
 591  *      Set up the channel for MWDMA or UDMA modes. Much the same as with
 592  *      PIO, load the mode number and then set MWDMA or UDMA flag.
 593  */
 594
 595 static void hpt370_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 596 {
 597         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 598         u32 addr1, addr2;
 599         u32 reg;
 600         u32 mode;
 601         u8 fast;
 602
 603         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 604         addr2 = 0x51 + 4 * ap->port_no;
 605
 606         /* Fast interrupt prediction disable, hold off interrupt disable */
 607         pci_read_config_byte(pdev, addr2, &fast);
 608         fast &= ~0x02;
 609         fast |= 0x01;
 610         pci_write_config_byte(pdev, addr2, fast);
 611
 612         pci_read_config_dword(pdev, addr1, &reg);
 613         mode = hpt37x_find_mode(ap, adev->dma_mode);
 614         mode |= 0x8000000;      /* FIFO in MWDMA or UDMA */
 615         mode &= ~0xC0000000;    /* Leave config bits alone */
 616         reg &= 0xC0000000;      /* Strip timing bits */
 617         pci_write_config_dword(pdev, addr1, reg | mode);
 618 }
 619
 620 /**
 621  *      hpt370_bmdma_start              -       DMA engine begin
 622  *      @qc: ATA command
 623  *
 624  *      The 370 and 370A want us to reset the DMA engine each time we
 625  *      use it. The 372 and later are fine.
 626  */
 627
 628 static void hpt370_bmdma_start(struct ata_queued_cmd *qc)
 629 {
 630         struct ata_port *ap = qc->ap;
 631         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 632         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 633         udelay(10);
 634         ata_bmdma_start(qc);
 635 }
 636
 637 /**
 638  *      hpt370_bmdma_end                -       DMA engine stop
 639  *      @qc: ATA command
 640  *
 641  *      Work around the HPT370 DMA engine.
 642  */
 643
 644 static void hpt370_bmdma_stop(struct ata_queued_cmd *qc)
 645 {
 646         struct ata_port *ap = qc->ap;
 647         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 648         u8 dma_stat = inb(ap->ioaddr.bmdma_addr + 2);
 649         u8 dma_cmd;
 650         unsigned long bmdma = ap->ioaddr.bmdma_addr;
 651
 652         if (dma_stat & 0x01) {
 653                 udelay(20);
 654                 dma_stat = inb(bmdma + 2);
 655         }
 656         if (dma_stat & 0x01) {
 657                 /* Clear the engine */
 658                 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 659                 udelay(10);
 660                 /* Stop DMA */
 661                 dma_cmd = inb(bmdma );
 662                 outb(dma_cmd & 0xFE, bmdma);
 663                 /* Clear Error */
 664                 dma_stat = inb(bmdma + 2);
 665                 outb(dma_stat | 0x06 , bmdma + 2);
 666                 /* Clear the engine */
 667                 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 668                 udelay(10);
 669         }
 670         ata_bmdma_stop(qc);
 671 }
 672
 673 /**
 674  *      hpt372_set_piomode              -       PIO setup
 675  *      @ap: ATA interface
 676  *      @adev: device on the interface
 677  *
 678  *      Perform PIO mode setup.
 679  */
 680
 681 static void hpt372_set_piomode(struct ata_port *ap, struct ata_device *adev)
 682 {
 683         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 684         u32 addr1, addr2;
 685         u32 reg;
 686         u32 mode;
 687         u8 fast;
 688
 689         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 690         addr2 = 0x51 + 4 * ap->port_no;
 691
 692         /* Fast interrupt prediction disable, hold off interrupt disable */
 693         pci_read_config_byte(pdev, addr2, &fast);
 694         fast &= ~0x07;
 695         pci_write_config_byte(pdev, addr2, fast);
 696
 697         pci_read_config_dword(pdev, addr1, &reg);
 698         mode = hpt37x_find_mode(ap, adev->pio_mode);
 699
 700         printk("Find mode for %d reports %X\n", adev->pio_mode, mode);
 701         mode &= ~0x80000000;    /* No FIFO in PIO */
 702         mode &= ~0x30070000;    /* Leave config bits alone */
 703         reg &= 0x30070000;      /* Strip timing bits */
 704         pci_write_config_dword(pdev, addr1, reg | mode);
 705 }
 706
 707 /**
 708  *      hpt372_set_dmamode              -       DMA timing setup
 709  *      @ap: ATA interface
 710  *      @adev: Device being configured
 711  *
 712  *      Set up the channel for MWDMA or UDMA modes. Much the same as with
 713  *      PIO, load the mode number and then set MWDMA or UDMA flag.
 714  */
 715
 716 static void hpt372_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 717 {
 718         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 719         u32 addr1, addr2;
 720         u32 reg;
 721         u32 mode;
 722         u8 fast;
 723
 724         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 725         addr2 = 0x51 + 4 * ap->port_no;
 726
 727         /* Fast interrupt prediction disable, hold off interrupt disable */
 728         pci_read_config_byte(pdev, addr2, &fast);
 729         fast &= ~0x07;
 730         pci_write_config_byte(pdev, addr2, fast);
 731
 732         pci_read_config_dword(pdev, addr1, &reg);
 733         mode = hpt37x_find_mode(ap, adev->dma_mode);
 734         printk("Find mode for DMA %d reports %X\n", adev->dma_mode, mode);
 735         mode &= ~0xC0000000;    /* Leave config bits alone */
 736         mode |= 0x80000000;     /* FIFO in MWDMA or UDMA */
 737         reg &= 0xC0000000;      /* Strip timing bits */
 738         pci_write_config_dword(pdev, addr1, reg | mode);
 739 }
 740
 741 /**
 742  *      hpt37x_bmdma_end                -       DMA engine stop
 743  *      @qc: ATA command
 744  *
 745  *      Clean up after the HPT372 and later DMA engine
 746  */
 747
 748 static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
 749 {
 750         struct ata_port *ap = qc->ap;
 751         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 752         int mscreg = 0x50 + 2 * ap->port_no;
 753         u8 bwsr_stat, msc_stat;
 754
 755         pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
 756         pci_read_config_byte(pdev, mscreg, &msc_stat);
 757         if (bwsr_stat & (1 << ap->port_no))
 758                 pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
 759         ata_bmdma_stop(qc);
 760 }
 761
 762
 763 static struct scsi_host_template hpt37x_sht = {
 764         .module                 = THIS_MODULE,
 765         .name                   = DRV_NAME,
 766         .ioctl                  = ata_scsi_ioctl,
 767         .queuecommand           = ata_scsi_queuecmd,
 768         .can_queue              = ATA_DEF_QUEUE,
 769         .this_id                = ATA_SHT_THIS_ID,
 770         .sg_tablesize           = LIBATA_MAX_PRD,
 771         .max_sectors            = ATA_MAX_SECTORS,
 772         .cmd_per_lun            = ATA_SHT_CMD_PER_LUN,
 773         .emulated               = ATA_SHT_EMULATED,
 774         .use_clustering         = ATA_SHT_USE_CLUSTERING,
 775         .proc_name              = DRV_NAME,
 776         .dma_boundary           = ATA_DMA_BOUNDARY,
 777         .slave_configure        = ata_scsi_slave_config,
 778         .slave_destroy          = ata_scsi_slave_destroy,
 779         .bios_param             = ata_std_bios_param,
 780 };
 781
 782 /*
 783  *      Configuration for HPT370
 784  */
 785
 786 static struct ata_port_operations hpt370_port_ops = {
 787         .port_disable   = ata_port_disable,
 788         .set_piomode    = hpt370_set_piomode,
 789         .set_dmamode    = hpt370_set_dmamode,
 790         .mode_filter    = hpt370_filter,
 791
 792         .tf_load        = ata_tf_load,
 793         .tf_read        = ata_tf_read,
 794         .check_status   = ata_check_status,
 795         .exec_command   = ata_exec_command,
 796         .dev_select     = ata_std_dev_select,
 797
 798         .freeze         = ata_bmdma_freeze,
 799         .thaw           = ata_bmdma_thaw,
 800         .error_handler  = hpt37x_error_handler,
 801         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 802
 803         .bmdma_setup    = ata_bmdma_setup,
 804         .bmdma_start    = hpt370_bmdma_start,
 805         .bmdma_stop     = hpt370_bmdma_stop,
 806         .bmdma_status   = ata_bmdma_status,
 807
 808         .qc_prep        = ata_qc_prep,
 809         .qc_issue       = ata_qc_issue_prot,
 810
 811         .data_xfer      = ata_pio_data_xfer,
 812
 813         .irq_handler    = ata_interrupt,
 814         .irq_clear      = ata_bmdma_irq_clear,
 815
 816         .port_start     = ata_port_start,
 817         .port_stop      = ata_port_stop,
 818         .host_stop      = ata_host_stop
 819 };
 820
 821 /*
 822  *      Configuration for HPT370A. Close to 370 but less filters
 823  */
 824
 825 static struct ata_port_operations hpt370a_port_ops = {
 826         .port_disable   = ata_port_disable,
 827         .set_piomode    = hpt370_set_piomode,
 828         .set_dmamode    = hpt370_set_dmamode,
 829         .mode_filter    = hpt370a_filter,
 830
 831         .tf_load        = ata_tf_load,
 832         .tf_read        = ata_tf_read,
 833         .check_status   = ata_check_status,
 834         .exec_command   = ata_exec_command,
 835         .dev_select     = ata_std_dev_select,
 836
 837         .freeze         = ata_bmdma_freeze,
 838         .thaw           = ata_bmdma_thaw,
 839         .error_handler  = hpt37x_error_handler,
 840         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 841
 842         .bmdma_setup    = ata_bmdma_setup,
 843         .bmdma_start    = hpt370_bmdma_start,
 844         .bmdma_stop     = hpt370_bmdma_stop,
 845         .bmdma_status   = ata_bmdma_status,
 846
 847         .qc_prep        = ata_qc_prep,
 848         .qc_issue       = ata_qc_issue_prot,
 849
 850         .data_xfer      = ata_pio_data_xfer,
 851
 852         .irq_handler    = ata_interrupt,
 853         .irq_clear      = ata_bmdma_irq_clear,
 854
 855         .port_start     = ata_port_start,
 856         .port_stop      = ata_port_stop,
 857         .host_stop      = ata_host_stop
 858 };
 859
 860 /*
 861  *      Configuration for HPT372, HPT371, HPT302. Slightly different PIO
 862  *      and DMA mode setting functionality.
 863  */
 864
 865 static struct ata_port_operations hpt372_port_ops = {
 866         .port_disable   = ata_port_disable,
 867         .set_piomode    = hpt372_set_piomode,
 868         .set_dmamode    = hpt372_set_dmamode,
 869         .mode_filter    = ata_pci_default_filter,
 870
 871         .tf_load        = ata_tf_load,
 872         .tf_read        = ata_tf_read,
 873         .check_status   = ata_check_status,
 874         .exec_command   = ata_exec_command,
 875         .dev_select     = ata_std_dev_select,
 876
 877         .freeze         = ata_bmdma_freeze,
 878         .thaw           = ata_bmdma_thaw,
 879         .error_handler  = hpt37x_error_handler,
 880         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 881
 882         .bmdma_setup    = ata_bmdma_setup,
 883         .bmdma_start    = ata_bmdma_start,
 884         .bmdma_stop     = hpt37x_bmdma_stop,
 885         .bmdma_status   = ata_bmdma_status,
 886
 887         .qc_prep        = ata_qc_prep,
 888         .qc_issue       = ata_qc_issue_prot,
 889
 890         .data_xfer      = ata_pio_data_xfer,
 891
 892         .irq_handler    = ata_interrupt,
 893         .irq_clear      = ata_bmdma_irq_clear,
 894
 895         .port_start     = ata_port_start,
 896         .port_stop      = ata_port_stop,
 897         .host_stop      = ata_host_stop
 898 };
 899
 900 /*
 901  *      Configuration for HPT374. Mode setting works like 372 and friends
 902  *      but we have a different cable detection procedure.
 903  */
 904
 905 static struct ata_port_operations hpt374_port_ops = {
 906         .port_disable   = ata_port_disable,
 907         .set_piomode    = hpt372_set_piomode,
 908         .set_dmamode    = hpt372_set_dmamode,
 909         .mode_filter    = ata_pci_default_filter,
 910
 911         .tf_load        = ata_tf_load,
 912         .tf_read        = ata_tf_read,
 913         .check_status   = ata_check_status,
 914         .exec_command   = ata_exec_command,
 915         .dev_select     = ata_std_dev_select,
 916
 917         .freeze         = ata_bmdma_freeze,
 918         .thaw           = ata_bmdma_thaw,
 919         .error_handler  = hpt374_error_handler,
 920         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 921
 922         .bmdma_setup    = ata_bmdma_setup,
 923         .bmdma_start    = ata_bmdma_start,
 924         .bmdma_stop     = hpt37x_bmdma_stop,
 925         .bmdma_status   = ata_bmdma_status,
 926
 927         .qc_prep        = ata_qc_prep,
 928         .qc_issue       = ata_qc_issue_prot,
 929
 930         .data_xfer      = ata_pio_data_xfer,
 931
 932         .irq_handler    = ata_interrupt,
 933         .irq_clear      = ata_bmdma_irq_clear,
 934
 935         .port_start     = ata_port_start,
 936         .port_stop      = ata_port_stop,
 937         .host_stop      = ata_host_stop
 938 };
 939
 940 /**
 941  *      htp37x_clock_slot       -       Turn timing to PC clock entry
 942  *      @freq: Reported frequency timing
 943  *      @base: Base timing
 944  *
 945  *      Turn the timing data intoa clock slot (0 for 33, 1 for 40, 2 for 50
 946  *      and 3 for 66Mhz)
 947  */
 948
 949 static int hpt37x_clock_slot(unsigned int freq, unsigned int base)
 950 {
 951         unsigned int f = (base * freq) / 192;   /* Mhz */
 952         if (f < 40)
 953                 return 0;       /* 33Mhz slot */
 954         if (f < 45)
 955                 return 1;       /* 40Mhz slot */
 956         if (f < 55)
 957                 return 2;       /* 50Mhz slot */
 958         return 3;               /* 60Mhz slot */
 959 }
 960
 961 /**
 962  *      hpt37x_calibrate_dpll           -       Calibrate the DPLL loop
 963  *      @dev: PCI device
 964  *
 965  *      Perform a calibration cycle on the HPT37x DPLL. Returns 1 if this
 966  *      succeeds
 967  */
 968
 969 static int hpt37x_calibrate_dpll(struct pci_dev *dev)
 970 {
 971         u8 reg5b;
 972         u32 reg5c;
 973         int tries;
 974
 975         for(tries = 0; tries < 0x5000; tries++) {
 976                 udelay(50);
 977                 pci_read_config_byte(dev, 0x5b, &reg5b);
 978                 if (reg5b & 0x80) {
 979                         /* See if it stays set */
 980                         for(tries = 0; tries < 0x1000; tries ++) {
 981                                 pci_read_config_byte(dev, 0x5b, &reg5b);
 982                                 /* Failed ? */
 983                                 if ((reg5b & 0x80) == 0)
 984                                         return 0;
 985                         }
 986                         /* Turn off tuning, we have the DPLL set */
 987                         pci_read_config_dword(dev, 0x5c, &reg5c);
 988                         pci_write_config_dword(dev, 0x5c, reg5c & ~ 0x100);
 989                         return 1;
 990                 }
 991         }
 992         /* Never went stable */
 993         return 0;
 994 }
 995 /**
 996  *      hpt37x_init_one         -       Initialise an HPT37X/302
 997  *      @dev: PCI device
 998  *      @id: Entry in match table
 999  *
1000  *      Initialise an HPT37x device. There are some interesting complications
1001  *      here. Firstly the chip may report 366 and be one of several variants.
1002  *      Secondly all the timings depend on the clock for the chip which we must
1003  *      detect and look up
1004  *
1005  *      This is the known chip mappings. It may be missing a couple of later
1006  *      releases.
1007  *
1008  *      Chip version            PCI             Rev     Notes
1009  *      HPT366                  4 (HPT366)      0       Other driver
1010  *      HPT366                  4 (HPT366)      1       Other driver
1011  *      HPT368                  4 (HPT366)      2       Other driver
1012  *      HPT370                  4 (HPT366)      3       UDMA100
1013  *      HPT370A                 4 (HPT366)      4       UDMA100
1014  *      HPT372                  4 (HPT366)      5       UDMA133 (1)
1015  *      HPT372N                 4 (HPT366)      6       Other driver
1016  *      HPT372A                 5 (HPT372)      1       UDMA133 (1)
1017  *      HPT372N                 5 (HPT372)      2       Other driver
1018  *      HPT302                  6 (HPT302)      1       UDMA133
1019  *      HPT302N                 6 (HPT302)      2       Other driver
1020  *      HPT371                  7 (HPT371)      *       UDMA133
1021  *      HPT374                  8 (HPT374)      *       UDMA133 4 channel
1022  *      HPT372N                 9 (HPT372N)     *       Other driver
1023  *
1024  *      (1) UDMA133 support depends on the bus clock
1025  */
1026
1027 static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
1028 {
1029         /* HPT370 - UDMA100 */
1030         static struct ata_port_info info_hpt370 = {
1031                 .sht = &hpt37x_sht,
1032                 .flags = ATA_FLAG_SLAVE_POSS|ATA_FLAG_SRST,
1033                 .pio_mask = 0x1f,
1034                 .mwdma_mask = 0x07,
1035                 .udma_mask = 0x3f,
1036                 .port_ops = &hpt370_port_ops
1037         };
1038         /* HPT370A - UDMA100 */
1039         static struct ata_port_info info_hpt370a = {
1040                 .sht = &hpt37x_sht,
1041                 .flags = ATA_FLAG_SLAVE_POSS|ATA_FLAG_SRST,
1042                 .pio_mask = 0x1f,
1043                 .mwdma_mask = 0x07,
1044                 .udma_mask = 0x3f,
1045                 .port_ops = &hpt370a_port_ops
1046         };
1047         /* HPT371, 372 and friends - UDMA133 */
1048         static struct ata_port_info info_hpt372 = {
1049                 .sht = &hpt37x_sht,
1050                 .flags = ATA_FLAG_SLAVE_POSS|ATA_FLAG_SRST,
1051                 .pio_mask = 0x1f,
1052                 .mwdma_mask = 0x07,
1053                 .udma_mask = 0x7f,
1054                 .port_ops = &hpt372_port_ops
1055         };
1056         /* HPT371, 372 and friends - UDMA100 at 50MHz clock */
1057         static struct ata_port_info info_hpt372_50 = {
1058                 .sht = &hpt37x_sht,
1059                 .flags = ATA_FLAG_SLAVE_POSS|ATA_FLAG_SRST,
1060                 .pio_mask = 0x1f,
1061                 .mwdma_mask = 0x07,
1062                 .udma_mask = 0x3f,
1063                 .port_ops = &hpt372_port_ops
1064         };
1065         /* HPT374 - UDMA133 */
1066         static struct ata_port_info info_hpt374 = {
1067                 .sht = &hpt37x_sht,
1068                 .flags = ATA_FLAG_SLAVE_POSS|ATA_FLAG_SRST,
1069                 .pio_mask = 0x1f,
1070                 .mwdma_mask = 0x07,
1071                 .udma_mask = 0x7f,
1072                 .port_ops = &hpt374_port_ops
1073         };
1074
1075         static const int MHz[4] = { 33, 40, 50, 66 };
1076
1077         struct ata_port_info *port_info[2];
1078         struct ata_port_info *port;
1079
1080         u8 irqmask;
1081         u32 class_rev;
1082         u32 freq;
1083
1084         const struct hpt_chip *chip_table;
1085         int clock_slot;
1086
1087         pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
1088         class_rev &= 0xFF;
1089
1090         if (dev->device == PCI_DEVICE_ID_TTI_HPT366) {
1091                 /* May be a later chip in disguise. Check */
1092                 /* Older chips are in the HPT366 driver. Ignore them */
1093                 if (class_rev < 3)
1094                         return -ENODEV;
1095                 /* N series chips have their own driver. Ignore */
1096                 if (class_rev == 6)
1097                         return -ENODEV;
1098
1099                 switch(class_rev) {
1100                         case 3:
1101                                 port = &info_hpt370;
1102                                 chip_table = &hpt370;
1103                                 break;
1104                         case 4:
1105                                 port = &info_hpt370a;
1106                                 chip_table = &hpt370a;
1107                                 break;
1108                         case 5:
1109                                 port = &info_hpt372;
1110                                 chip_table = &hpt372;
1111                                 break;
1112                         default:
1113                                 printk(KERN_ERR "pata_hpt37x: Unknown HPT366 subtype please report (%d).\n", class_rev);
1114                                 return -ENODEV;
1115                 }
1116         } else {
1117                 switch(dev->device) {
1118                         case PCI_DEVICE_ID_TTI_HPT372:
1119                                 /* 372N if rev >= 2*/
1120                                 if (class_rev >= 2)
1121                                         return -ENODEV;
1122                                 port = &info_hpt372;
1123                                 chip_table = &hpt372a;
1124                                 break;
1125                         case PCI_DEVICE_ID_TTI_HPT302:
1126                                 /* 302N if rev > 1 */
1127                                 if (class_rev > 1)
1128                                         return -ENODEV;
1129                                 port = &info_hpt372;
1130                                 /* Check this */
1131                                 chip_table = &hpt302;
1132                                 break;
1133                         case PCI_DEVICE_ID_TTI_HPT371:
1134                                 port = &info_hpt372;
1135                                 chip_table = &hpt371;
1136                                 break;
1137                         case PCI_DEVICE_ID_TTI_HPT374:
1138                                 chip_table = &hpt374;
1139                                 port = &info_hpt374;
1140                                 break;
1141                         default:
1142                                 printk(KERN_ERR "pata_hpt37x: PCI table is bogus please report (%d).\n", dev->device);
1143                                 return -ENODEV;
1144                 }
1145         }
1146         /* Ok so this is a chip we support */
1147
1148         pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
1149         pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
1150         pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
1151         pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
1152
1153         pci_read_config_byte(dev, 0x5A, &irqmask);
1154         irqmask &= ~0x10;
1155         pci_write_config_byte(dev, 0x5a, irqmask);
1156
1157         /*
1158          * default to pci clock. make sure MA15/16 are set to output
1159          * to prevent drives having problems with 40-pin cables. Needed
1160          * for some drives such as IBM-DTLA which will not enter ready
1161          * state on reset when PDIAG is a input.
1162          */
1163
1164         pci_write_config_byte(dev, 0x5b, 0x23);
1165
1166         pci_read_config_dword(dev, 0x70, &freq);
1167         if ((freq >> 12) != 0xABCDE) {
1168                 int i;
1169                 u8 sr;
1170                 u32 total = 0;
1171
1172                 printk(KERN_WARNING "pata_hpt37x: BIOS has not set timing clocks.\n");
1173
1174                 /* This is the process the HPT371 BIOS is reported to use */
1175                 for(i = 0; i < 128; i++) {
1176                         pci_read_config_byte(dev, 0x78, &sr);
1177                         total += sr;
1178                         udelay(15);
1179                 }
1180                 freq = total / 128;
1181         }
1182         freq &= 0x1FF;
1183
1184         /*
1185          *      Turn the frequency check into a band and then find a timing
1186          *      table to match it.
1187          */
1188
1189         clock_slot = hpt37x_clock_slot(freq, chip_table->base);
1190         if (chip_table->clocks[clock_slot] == NULL) {
1191                 /*
1192                  *      We need to try PLL mode instead
1193                  */
1194                 unsigned int f_low = (MHz[clock_slot] * chip_table->base) / 192;
1195                 unsigned int f_high = f_low + 2;
1196                 int adjust;
1197
1198                 for(adjust = 0; adjust < 8; adjust++) {
1199                         if (hpt37x_calibrate_dpll(dev))
1200                                 break;
1201                         /* See if it'll settle at a fractionally different clock */
1202                         if ((adjust & 3) == 3) {
1203                                 f_low --;
1204                                 f_high ++;
1205                         }
1206                         pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low);
1207                 }
1208                 if (adjust == 8) {
1209                         printk(KERN_WARNING "hpt37x: DPLL did not stabilize.\n");
1210                         return -ENODEV;
1211                 }
1212                 /* Check if this works for all cases */
1213                 port->private_data = (void *)hpt370_timings_66;
1214
1215                 printk(KERN_INFO "hpt37x: Bus clock %dMHz, using DPLL.\n", MHz[clock_slot]);
1216         } else {
1217                 port->private_data = (void *)chip_table->clocks[clock_slot];
1218                 /*
1219                  *      Perform a final fixup. The 371 and 372 clock determines
1220                  *      if UDMA133 is available.
1221                  */
1222
1223                 if (clock_slot == 2 && chip_table == &hpt372) { /* 50Mhz */
1224                         printk(KERN_WARNING "pata_hpt37x: No UDMA133 support available with 50MHz bus clock.\n");
1225                         if (port == &info_hpt372)
1226                                 port = &info_hpt372_50;
1227                         else BUG();
1228                 }
1229                 printk(KERN_INFO "hpt37x: %s: Bus clock %dMHz.\n", chip_table->name, MHz[clock_slot]);
1230         }
1231         port_info[0] = port_info[1] = port;
1232         /* Now kick off ATA set up */
1233         return ata_pci_init_one(dev, port_info, 2);
1234 }
1235
1236 static const struct pci_device_id hpt37x[] = {
1237         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT366), },
1238         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT371), },
1239         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT372), },
1240         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT374), },
1241         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT302), },
1242
1243         { },
1244 };
1245
1246 static struct pci_driver hpt37x_pci_driver = {
1247         .name           = DRV_NAME,
1248         .id_table       = hpt37x,
1249         .probe          = hpt37x_init_one,
1250         .remove         = ata_pci_remove_one
1251 };
1252
1253 static int __init hpt37x_init(void)
1254 {
1255         return pci_register_driver(&hpt37x_pci_driver);
1256 }
1257
1258 static void __exit hpt37x_exit(void)
1259 {
1260         pci_unregister_driver(&hpt37x_pci_driver);
1261 }
1262
1263 MODULE_AUTHOR("Alan Cox");
1264 MODULE_DESCRIPTION("low-level driver for the Highpoint HPT37x/30x");
1265 MODULE_LICENSE("GPL");
1266 MODULE_DEVICE_TABLE(pci, hpt37x);
1267 MODULE_VERSION(DRV_VERSION);
1268
1269 module_init(hpt37x_init);
1270 module_exit(hpt37x_exit);