git.oblomov.eu Git - linux-2.6/blob - 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-2007     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.11"
  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
  43  *        DMA. cycles = value + 1
  44  * 4:8    data_low_time. active time of DIOW_/DIOR_ for PIO and MW
  45  *        DMA. 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:21  udma_cycle_time. clock freq and clock cycles for UDMA xfer.
  51  *        during task file register access.
  52  * 22:24  pre_high_time. time to initialize 1st cycle for PIO and MW DMA
  53  *        xfer.
  54  * 25:27  cmd_pre_high_time. time to initialize 1st PIO cycle for task
  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.
  60  * 31     FIFO enable.
  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, const char *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 *bad_ata33[] = {
 242         "Maxtor 92720U8", "Maxtor 92040U6", "Maxtor 91360U4", "Maxtor 91020U3", "Maxtor 90845U3", "Maxtor 90650U2",
 243         "Maxtor 91360D8", "Maxtor 91190D7", "Maxtor 91020D6", "Maxtor 90845D5", "Maxtor 90680D4", "Maxtor 90510D3", "Maxtor 90340D2",
 244         "Maxtor 91152D8", "Maxtor 91008D7", "Maxtor 90845D6", "Maxtor 90840D6", "Maxtor 90720D5", "Maxtor 90648D5", "Maxtor 90576D4",
 245         "Maxtor 90510D4",
 246         "Maxtor 90432D3", "Maxtor 90288D2", "Maxtor 90256D2",
 247         "Maxtor 91000D8", "Maxtor 90910D8", "Maxtor 90875D7", "Maxtor 90840D7", "Maxtor 90750D6", "Maxtor 90625D5", "Maxtor 90500D4",
 248         "Maxtor 91728D8", "Maxtor 91512D7", "Maxtor 91303D6", "Maxtor 91080D5", "Maxtor 90845D4", "Maxtor 90680D4", "Maxtor 90648D3", "Maxtor 90432D2",
 249         NULL
 250 };
 251
 252 static const char *bad_ata100_5[] = {
 253         "IBM-DTLA-307075",
 254         "IBM-DTLA-307060",
 255         "IBM-DTLA-307045",
 256         "IBM-DTLA-307030",
 257         "IBM-DTLA-307020",
 258         "IBM-DTLA-307015",
 259         "IBM-DTLA-305040",
 260         "IBM-DTLA-305030",
 261         "IBM-DTLA-305020",
 262         "IC35L010AVER07-0",
 263         "IC35L020AVER07-0",
 264         "IC35L030AVER07-0",
 265         "IC35L040AVER07-0",
 266         "IC35L060AVER07-0",
 267         "WDC AC310200R",
 268         NULL
 269 };
 270
 271 /**
 272  *      hpt370_filter   -       mode selection filter
 273  *      @adev: ATA device
 274  *
 275  *      Block UDMA on devices that cause trouble with this controller.
 276  */
 277
 278 static unsigned long hpt370_filter(struct ata_device *adev, unsigned long mask)
 279 {
 280         if (adev->class == ATA_DEV_ATA) {
 281                 if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33))
 282                         mask &= ~ATA_MASK_UDMA;
 283                 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
 284                         mask &= ~(0xE0 << ATA_SHIFT_UDMA);
 285         }
 286         return ata_bmdma_mode_filter(adev, mask);
 287 }
 288
 289 /**
 290  *      hpt370a_filter  -       mode selection filter
 291  *      @adev: ATA device
 292  *
 293  *      Block UDMA on devices that cause trouble with this controller.
 294  */
 295
 296 static unsigned long hpt370a_filter(struct ata_device *adev, unsigned long mask)
 297 {
 298         if (adev->class == ATA_DEV_ATA) {
 299                 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
 300                         mask &= ~(0xE0 << ATA_SHIFT_UDMA);
 301         }
 302         return ata_bmdma_mode_filter(adev, mask);
 303 }
 304
 305 /**
 306  *      hpt37x_pre_reset        -       reset the hpt37x bus
 307  *      @link: ATA link to reset
 308  *      @deadline: deadline jiffies for the operation
 309  *
 310  *      Perform the initial reset handling for the 370/372 and 374 func 0
 311  */
 312
 313 static int hpt37x_pre_reset(struct ata_link *link, unsigned long deadline)
 314 {
 315         u8 scr2, ata66;
 316         struct ata_port *ap = link->ap;
 317         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 318         static const struct pci_bits hpt37x_enable_bits[] = {
 319                 { 0x50, 1, 0x04, 0x04 },
 320                 { 0x54, 1, 0x04, 0x04 }
 321         };
 322         if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
 323                 return -ENOENT;
 324
 325         pci_read_config_byte(pdev, 0x5B, &scr2);
 326         pci_write_config_byte(pdev, 0x5B, scr2 & ~0x01);
 327         /* Cable register now active */
 328         pci_read_config_byte(pdev, 0x5A, &ata66);
 329         /* Restore state */
 330         pci_write_config_byte(pdev, 0x5B, scr2);
 331
 332         if (ata66 & (2 >> ap->port_no))
 333                 ap->cbl = ATA_CBL_PATA40;
 334         else
 335                 ap->cbl = ATA_CBL_PATA80;
 336
 337         /* Reset the state machine */
 338         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 339         udelay(100);
 340
 341         return ata_sff_prereset(link, deadline);
 342 }
 343
 344 static int hpt374_fn1_pre_reset(struct ata_link *link, unsigned long deadline)
 345 {
 346         static const struct pci_bits hpt37x_enable_bits[] = {
 347                 { 0x50, 1, 0x04, 0x04 },
 348                 { 0x54, 1, 0x04, 0x04 }
 349         };
 350         u16 mcr3;
 351         u8 ata66;
 352         struct ata_port *ap = link->ap;
 353         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 354         unsigned int mcrbase = 0x50 + 4 * ap->port_no;
 355
 356         if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
 357                 return -ENOENT;
 358
 359         /* Do the extra channel work */
 360         pci_read_config_word(pdev, mcrbase + 2, &mcr3);
 361         /* Set bit 15 of 0x52 to enable TCBLID as input
 362          */
 363         pci_write_config_word(pdev, mcrbase + 2, mcr3 | 0x8000);
 364         pci_read_config_byte(pdev, 0x5A, &ata66);
 365         /* Reset TCBLID/FCBLID to output */
 366         pci_write_config_word(pdev, mcrbase + 2, mcr3);
 367
 368         if (ata66 & (2 >> ap->port_no))
 369                 ap->cbl = ATA_CBL_PATA40;
 370         else
 371                 ap->cbl = ATA_CBL_PATA80;
 372
 373         /* Reset the state machine */
 374         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 375         udelay(100);
 376
 377         return ata_sff_prereset(link, deadline);
 378 }
 379
 380 /**
 381  *      hpt370_set_piomode              -       PIO setup
 382  *      @ap: ATA interface
 383  *      @adev: device on the interface
 384  *
 385  *      Perform PIO mode setup.
 386  */
 387
 388 static void hpt370_set_piomode(struct ata_port *ap, struct ata_device *adev)
 389 {
 390         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 391         u32 addr1, addr2;
 392         u32 reg;
 393         u32 mode;
 394         u8 fast;
 395
 396         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 397         addr2 = 0x51 + 4 * ap->port_no;
 398
 399         /* Fast interrupt prediction disable, hold off interrupt disable */
 400         pci_read_config_byte(pdev, addr2, &fast);
 401         fast &= ~0x02;
 402         fast |= 0x01;
 403         pci_write_config_byte(pdev, addr2, fast);
 404
 405         pci_read_config_dword(pdev, addr1, &reg);
 406         mode = hpt37x_find_mode(ap, adev->pio_mode);
 407         mode &= ~0x8000000;     /* No FIFO in PIO */
 408         mode &= ~0x30070000;    /* Leave config bits alone */
 409         reg &= 0x30070000;      /* Strip timing bits */
 410         pci_write_config_dword(pdev, addr1, reg | mode);
 411 }
 412
 413 /**
 414  *      hpt370_set_dmamode              -       DMA timing setup
 415  *      @ap: ATA interface
 416  *      @adev: Device being configured
 417  *
 418  *      Set up the channel for MWDMA or UDMA modes. Much the same as with
 419  *      PIO, load the mode number and then set MWDMA or UDMA flag.
 420  */
 421
 422 static void hpt370_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 423 {
 424         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 425         u32 addr1, addr2;
 426         u32 reg;
 427         u32 mode;
 428         u8 fast;
 429
 430         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 431         addr2 = 0x51 + 4 * ap->port_no;
 432
 433         /* Fast interrupt prediction disable, hold off interrupt disable */
 434         pci_read_config_byte(pdev, addr2, &fast);
 435         fast &= ~0x02;
 436         fast |= 0x01;
 437         pci_write_config_byte(pdev, addr2, fast);
 438
 439         pci_read_config_dword(pdev, addr1, &reg);
 440         mode = hpt37x_find_mode(ap, adev->dma_mode);
 441         mode |= 0x8000000;      /* FIFO in MWDMA or UDMA */
 442         mode &= ~0xC0000000;    /* Leave config bits alone */
 443         reg &= 0xC0000000;      /* Strip timing bits */
 444         pci_write_config_dword(pdev, addr1, reg | mode);
 445 }
 446
 447 /**
 448  *      hpt370_bmdma_start              -       DMA engine begin
 449  *      @qc: ATA command
 450  *
 451  *      The 370 and 370A want us to reset the DMA engine each time we
 452  *      use it. The 372 and later are fine.
 453  */
 454
 455 static void hpt370_bmdma_start(struct ata_queued_cmd *qc)
 456 {
 457         struct ata_port *ap = qc->ap;
 458         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 459         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 460         udelay(10);
 461         ata_bmdma_start(qc);
 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         u8 dma_stat = ioread8(ap->ioaddr.bmdma_addr + 2);
 476         u8 dma_cmd;
 477         void __iomem *bmdma = ap->ioaddr.bmdma_addr;
 478
 479         if (dma_stat & 0x01) {
 480                 udelay(20);
 481                 dma_stat = ioread8(bmdma + 2);
 482         }
 483         if (dma_stat & 0x01) {
 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 );
 489                 iowrite8(dma_cmd & 0xFE, bmdma);
 490                 /* Clear Error */
 491                 dma_stat = ioread8(bmdma + 2);
 492                 iowrite8(dma_stat | 0x06 , bmdma + 2);
 493                 /* Clear the engine */
 494                 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
 495                 udelay(10);
 496         }
 497         ata_bmdma_stop(qc);
 498 }
 499
 500 /**
 501  *      hpt372_set_piomode              -       PIO setup
 502  *      @ap: ATA interface
 503  *      @adev: device on the interface
 504  *
 505  *      Perform PIO mode setup.
 506  */
 507
 508 static void hpt372_set_piomode(struct ata_port *ap, struct ata_device *adev)
 509 {
 510         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 511         u32 addr1, addr2;
 512         u32 reg;
 513         u32 mode;
 514         u8 fast;
 515
 516         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 517         addr2 = 0x51 + 4 * ap->port_no;
 518
 519         /* Fast interrupt prediction disable, hold off interrupt disable */
 520         pci_read_config_byte(pdev, addr2, &fast);
 521         fast &= ~0x07;
 522         pci_write_config_byte(pdev, addr2, fast);
 523
 524         pci_read_config_dword(pdev, addr1, &reg);
 525         mode = hpt37x_find_mode(ap, adev->pio_mode);
 526
 527         printk("Find mode for %d reports %X\n", adev->pio_mode, mode);
 528         mode &= ~0x80000000;    /* No FIFO in PIO */
 529         mode &= ~0x30070000;    /* Leave config bits alone */
 530         reg &= 0x30070000;      /* Strip timing bits */
 531         pci_write_config_dword(pdev, addr1, reg | mode);
 532 }
 533
 534 /**
 535  *      hpt372_set_dmamode              -       DMA timing setup
 536  *      @ap: ATA interface
 537  *      @adev: Device being configured
 538  *
 539  *      Set up the channel for MWDMA or UDMA modes. Much the same as with
 540  *      PIO, load the mode number and then set MWDMA or UDMA flag.
 541  */
 542
 543 static void hpt372_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 544 {
 545         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 546         u32 addr1, addr2;
 547         u32 reg;
 548         u32 mode;
 549         u8 fast;
 550
 551         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
 552         addr2 = 0x51 + 4 * ap->port_no;
 553
 554         /* Fast interrupt prediction disable, hold off interrupt disable */
 555         pci_read_config_byte(pdev, addr2, &fast);
 556         fast &= ~0x07;
 557         pci_write_config_byte(pdev, addr2, fast);
 558
 559         pci_read_config_dword(pdev, addr1, &reg);
 560         mode = hpt37x_find_mode(ap, adev->dma_mode);
 561         printk("Find mode for DMA %d reports %X\n", adev->dma_mode, mode);
 562         mode &= ~0xC0000000;    /* Leave config bits alone */
 563         mode |= 0x80000000;     /* FIFO in MWDMA or UDMA */
 564         reg &= 0xC0000000;      /* Strip timing bits */
 565         pci_write_config_dword(pdev, addr1, reg | mode);
 566 }
 567
 568 /**
 569  *      hpt37x_bmdma_end                -       DMA engine stop
 570  *      @qc: ATA command
 571  *
 572  *      Clean up after the HPT372 and later DMA engine
 573  */
 574
 575 static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
 576 {
 577         struct ata_port *ap = qc->ap;
 578         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 579         int mscreg = 0x50 + 4 * ap->port_no;
 580         u8 bwsr_stat, msc_stat;
 581
 582         pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
 583         pci_read_config_byte(pdev, mscreg, &msc_stat);
 584         if (bwsr_stat & (1 << ap->port_no))
 585                 pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
 586         ata_bmdma_stop(qc);
 587 }
 588
 589
 590 static struct scsi_host_template hpt37x_sht = {
 591         ATA_BMDMA_SHT(DRV_NAME),
 592 };
 593
 594 /*
 595  *      Configuration for HPT370
 596  */
 597
 598 static struct ata_port_operations hpt370_port_ops = {
 599         .inherits       = &ata_bmdma_port_ops,
 600
 601         .bmdma_start    = hpt370_bmdma_start,
 602         .bmdma_stop     = hpt370_bmdma_stop,
 603
 604         .mode_filter    = hpt370_filter,
 605         .set_piomode    = hpt370_set_piomode,
 606         .set_dmamode    = hpt370_set_dmamode,
 607         .prereset       = hpt37x_pre_reset,
 608 };
 609
 610 /*
 611  *      Configuration for HPT370A. Close to 370 but less filters
 612  */
 613
 614 static struct ata_port_operations hpt370a_port_ops = {
 615         .inherits       = &hpt370_port_ops,
 616         .mode_filter    = hpt370a_filter,
 617 };
 618
 619 /*
 620  *      Configuration for HPT372, HPT371, HPT302. Slightly different PIO
 621  *      and DMA mode setting functionality.
 622  */
 623
 624 static struct ata_port_operations hpt372_port_ops = {
 625         .inherits       = &ata_bmdma_port_ops,
 626
 627         .bmdma_stop     = hpt37x_bmdma_stop,
 628
 629         .set_piomode    = hpt372_set_piomode,
 630         .set_dmamode    = hpt372_set_dmamode,
 631         .prereset       = hpt37x_pre_reset,
 632 };
 633
 634 /*
 635  *      Configuration for HPT374. Mode setting works like 372 and friends
 636  *      but we have a different cable detection procedure for function 1.
 637  */
 638
 639 static struct ata_port_operations hpt374_fn1_port_ops = {
 640         .inherits       = &hpt372_port_ops,
 641         .prereset       = hpt374_fn1_pre_reset,
 642 };
 643
 644 /**
 645  *      htp37x_clock_slot       -       Turn timing to PC clock entry
 646  *      @freq: Reported frequency timing
 647  *      @base: Base timing
 648  *
 649  *      Turn the timing data intoa clock slot (0 for 33, 1 for 40, 2 for 50
 650  *      and 3 for 66Mhz)
 651  */
 652
 653 static int hpt37x_clock_slot(unsigned int freq, unsigned int base)
 654 {
 655         unsigned int f = (base * freq) / 192;   /* Mhz */
 656         if (f < 40)
 657                 return 0;       /* 33Mhz slot */
 658         if (f < 45)
 659                 return 1;       /* 40Mhz slot */
 660         if (f < 55)
 661                 return 2;       /* 50Mhz slot */
 662         return 3;               /* 60Mhz slot */
 663 }
 664
 665 /**
 666  *      hpt37x_calibrate_dpll           -       Calibrate the DPLL loop
 667  *      @dev: PCI device
 668  *
 669  *      Perform a calibration cycle on the HPT37x DPLL. Returns 1 if this
 670  *      succeeds
 671  */
 672
 673 static int hpt37x_calibrate_dpll(struct pci_dev *dev)
 674 {
 675         u8 reg5b;
 676         u32 reg5c;
 677         int tries;
 678
 679         for(tries = 0; tries < 0x5000; tries++) {
 680                 udelay(50);
 681                 pci_read_config_byte(dev, 0x5b, &reg5b);
 682                 if (reg5b & 0x80) {
 683                         /* See if it stays set */
 684                         for(tries = 0; tries < 0x1000; tries ++) {
 685                                 pci_read_config_byte(dev, 0x5b, &reg5b);
 686                                 /* Failed ? */
 687                                 if ((reg5b & 0x80) == 0)
 688                                         return 0;
 689                         }
 690                         /* Turn off tuning, we have the DPLL set */
 691                         pci_read_config_dword(dev, 0x5c, &reg5c);
 692                         pci_write_config_dword(dev, 0x5c, reg5c & ~ 0x100);
 693                         return 1;
 694                 }
 695         }
 696         /* Never went stable */
 697         return 0;
 698 }
 699
 700 static u32 hpt374_read_freq(struct pci_dev *pdev)
 701 {
 702         u32 freq;
 703         unsigned long io_base = pci_resource_start(pdev, 4);
 704         if (PCI_FUNC(pdev->devfn) & 1) {
 705                 struct pci_dev *pdev_0;
 706
 707                 pdev_0 = pci_get_slot(pdev->bus, pdev->devfn - 1);
 708                 /* Someone hot plugged the controller on us ? */
 709                 if (pdev_0 == NULL)
 710                         return 0;
 711                 io_base = pci_resource_start(pdev_0, 4);
 712                 freq = inl(io_base + 0x90);
 713                 pci_dev_put(pdev_0);
 714         } else
 715                 freq = inl(io_base + 0x90);
 716         return freq;
 717 }
 718
 719 /**
 720  *      hpt37x_init_one         -       Initialise an HPT37X/302
 721  *      @dev: PCI device
 722  *      @id: Entry in match table
 723  *
 724  *      Initialise an HPT37x device. There are some interesting complications
 725  *      here. Firstly the chip may report 366 and be one of several variants.
 726  *      Secondly all the timings depend on the clock for the chip which we must
 727  *      detect and look up
 728  *
 729  *      This is the known chip mappings. It may be missing a couple of later
 730  *      releases.
 731  *
 732  *      Chip version            PCI             Rev     Notes
 733  *      HPT366                  4 (HPT366)      0       Other driver
 734  *      HPT366                  4 (HPT366)      1       Other driver
 735  *      HPT368                  4 (HPT366)      2       Other driver
 736  *      HPT370                  4 (HPT366)      3       UDMA100
 737  *      HPT370A                 4 (HPT366)      4       UDMA100
 738  *      HPT372                  4 (HPT366)      5       UDMA133 (1)
 739  *      HPT372N                 4 (HPT366)      6       Other driver
 740  *      HPT372A                 5 (HPT372)      1       UDMA133 (1)
 741  *      HPT372N                 5 (HPT372)      2       Other driver
 742  *      HPT302                  6 (HPT302)      1       UDMA133
 743  *      HPT302N                 6 (HPT302)      2       Other driver
 744  *      HPT371                  7 (HPT371)      *       UDMA133
 745  *      HPT374                  8 (HPT374)      *       UDMA133 4 channel
 746  *      HPT372N                 9 (HPT372N)     *       Other driver
 747  *
 748  *      (1) UDMA133 support depends on the bus clock
 749  */
 750
 751 static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
 752 {
 753         /* HPT370 - UDMA100 */
 754         static const struct ata_port_info info_hpt370 = {
 755                 .flags = ATA_FLAG_SLAVE_POSS,
 756                 .pio_mask = 0x1f,
 757                 .mwdma_mask = 0x07,
 758                 .udma_mask = ATA_UDMA5,
 759                 .port_ops = &hpt370_port_ops
 760         };
 761         /* HPT370A - UDMA100 */
 762         static const struct ata_port_info info_hpt370a = {
 763                 .flags = ATA_FLAG_SLAVE_POSS,
 764                 .pio_mask = 0x1f,
 765                 .mwdma_mask = 0x07,
 766                 .udma_mask = ATA_UDMA5,
 767                 .port_ops = &hpt370a_port_ops
 768         };
 769         /* HPT370 - UDMA100 */
 770         static const struct ata_port_info info_hpt370_33 = {
 771                 .flags = ATA_FLAG_SLAVE_POSS,
 772                 .pio_mask = 0x1f,
 773                 .mwdma_mask = 0x07,
 774                 .udma_mask = ATA_UDMA5,
 775                 .port_ops = &hpt370_port_ops
 776         };
 777         /* HPT370A - UDMA100 */
 778         static const struct ata_port_info info_hpt370a_33 = {
 779                 .flags = ATA_FLAG_SLAVE_POSS,
 780                 .pio_mask = 0x1f,
 781                 .mwdma_mask = 0x07,
 782                 .udma_mask = ATA_UDMA5,
 783                 .port_ops = &hpt370a_port_ops
 784         };
 785         /* HPT371, 372 and friends - UDMA133 */
 786         static const struct ata_port_info info_hpt372 = {
 787                 .flags = ATA_FLAG_SLAVE_POSS,
 788                 .pio_mask = 0x1f,
 789                 .mwdma_mask = 0x07,
 790                 .udma_mask = ATA_UDMA6,
 791                 .port_ops = &hpt372_port_ops
 792         };
 793         /* HPT374 - UDMA100, function 1 uses different prereset method */
 794         static const struct ata_port_info info_hpt374_fn0 = {
 795                 .flags = ATA_FLAG_SLAVE_POSS,
 796                 .pio_mask = 0x1f,
 797                 .mwdma_mask = 0x07,
 798                 .udma_mask = ATA_UDMA5,
 799                 .port_ops = &hpt372_port_ops
 800         };
 801         static const struct ata_port_info info_hpt374_fn1 = {
 802                 .flags = ATA_FLAG_SLAVE_POSS,
 803                 .pio_mask = 0x1f,
 804                 .mwdma_mask = 0x07,
 805                 .udma_mask = ATA_UDMA5,
 806                 .port_ops = &hpt374_fn1_port_ops
 807         };
 808
 809         static const int MHz[4] = { 33, 40, 50, 66 };
 810         void *private_data = NULL;
 811         const struct ata_port_info *ppi[] = { NULL, NULL };
 812
 813         u8 irqmask;
 814         u32 class_rev;
 815         u8 mcr1;
 816         u32 freq;
 817         int prefer_dpll = 1;
 818
 819         unsigned long iobase = pci_resource_start(dev, 4);
 820
 821         const struct hpt_chip *chip_table;
 822         int clock_slot;
 823         int rc;
 824
 825         rc = pcim_enable_device(dev);
 826         if (rc)
 827                 return rc;
 828
 829         pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
 830         class_rev &= 0xFF;
 831
 832         if (dev->device == PCI_DEVICE_ID_TTI_HPT366) {
 833                 /* May be a later chip in disguise. Check */
 834                 /* Older chips are in the HPT366 driver. Ignore them */
 835                 if (class_rev < 3)
 836                         return -ENODEV;
 837                 /* N series chips have their own driver. Ignore */
 838                 if (class_rev == 6)
 839                         return -ENODEV;
 840
 841                 switch(class_rev) {
 842                         case 3:
 843                                 ppi[0] = &info_hpt370;
 844                                 chip_table = &hpt370;
 845                                 prefer_dpll = 0;
 846                                 break;
 847                         case 4:
 848                                 ppi[0] = &info_hpt370a;
 849                                 chip_table = &hpt370a;
 850                                 prefer_dpll = 0;
 851                                 break;
 852                         case 5:
 853                                 ppi[0] = &info_hpt372;
 854                                 chip_table = &hpt372;
 855                                 break;
 856                         default:
 857                                 printk(KERN_ERR "pata_hpt37x: Unknown HPT366 subtype please report (%d).\n", class_rev);
 858                                 return -ENODEV;
 859                 }
 860         } else {
 861                 switch(dev->device) {
 862                         case PCI_DEVICE_ID_TTI_HPT372:
 863                                 /* 372N if rev >= 2*/
 864                                 if (class_rev >= 2)
 865                                         return -ENODEV;
 866                                 ppi[0] = &info_hpt372;
 867                                 chip_table = &hpt372a;
 868                                 break;
 869                         case PCI_DEVICE_ID_TTI_HPT302:
 870                                 /* 302N if rev > 1 */
 871                                 if (class_rev > 1)
 872                                         return -ENODEV;
 873                                 ppi[0] = &info_hpt372;
 874                                 /* Check this */
 875                                 chip_table = &hpt302;
 876                                 break;
 877                         case PCI_DEVICE_ID_TTI_HPT371:
 878                                 if (class_rev > 1)
 879                                         return -ENODEV;
 880                                 ppi[0] = &info_hpt372;
 881                                 chip_table = &hpt371;
 882                                 /* Single channel device, master is not present
 883                                    but the BIOS (or us for non x86) must mark it
 884                                    absent */
 885                                 pci_read_config_byte(dev, 0x50, &mcr1);
 886                                 mcr1 &= ~0x04;
 887                                 pci_write_config_byte(dev, 0x50, mcr1);
 888                                 break;
 889                         case PCI_DEVICE_ID_TTI_HPT374:
 890                                 chip_table = &hpt374;
 891                                 if (!(PCI_FUNC(dev->devfn) & 1))
 892                                         *ppi = &info_hpt374_fn0;
 893                                 else
 894                                         *ppi = &info_hpt374_fn1;
 895                                 break;
 896                         default:
 897                                 printk(KERN_ERR "pata_hpt37x: PCI table is bogus please report (%d).\n", dev->device);
 898                                 return -ENODEV;
 899                 }
 900         }
 901         /* Ok so this is a chip we support */
 902
 903         pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
 904         pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
 905         pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
 906         pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
 907
 908         pci_read_config_byte(dev, 0x5A, &irqmask);
 909         irqmask &= ~0x10;
 910         pci_write_config_byte(dev, 0x5a, irqmask);
 911
 912         /*
 913          * default to pci clock. make sure MA15/16 are set to output
 914          * to prevent drives having problems with 40-pin cables. Needed
 915          * for some drives such as IBM-DTLA which will not enter ready
 916          * state on reset when PDIAG is a input.
 917          */
 918
 919         pci_write_config_byte(dev, 0x5b, 0x23);
 920
 921         /*
 922          * HighPoint does this for HPT372A.
 923          * NOTE: This register is only writeable via I/O space.
 924          */
 925         if (chip_table == &hpt372a)
 926                 outb(0x0e, iobase + 0x9c);
 927
 928         /* Some devices do not let this value be accessed via PCI space
 929            according to the old driver. In addition we must use the value
 930            from FN 0 on the HPT374 */
 931
 932         if (chip_table == &hpt374) {
 933                 freq = hpt374_read_freq(dev);
 934                 if (freq == 0)
 935                         return -ENODEV;
 936         } else
 937                 freq = inl(iobase + 0x90);
 938
 939         if ((freq >> 12) != 0xABCDE) {
 940                 int i;
 941                 u8 sr;
 942                 u32 total = 0;
 943
 944                 printk(KERN_WARNING "pata_hpt37x: BIOS has not set timing clocks.\n");
 945
 946                 /* This is the process the HPT371 BIOS is reported to use */
 947                 for(i = 0; i < 128; i++) {
 948                         pci_read_config_byte(dev, 0x78, &sr);
 949                         total += sr & 0x1FF;
 950                         udelay(15);
 951                 }
 952                 freq = total / 128;
 953         }
 954         freq &= 0x1FF;
 955
 956         /*
 957          *      Turn the frequency check into a band and then find a timing
 958          *      table to match it.
 959          */
 960
 961         clock_slot = hpt37x_clock_slot(freq, chip_table->base);
 962         if (chip_table->clocks[clock_slot] == NULL || prefer_dpll) {
 963                 /*
 964                  *      We need to try PLL mode instead
 965                  *
 966                  *      For non UDMA133 capable devices we should
 967                  *      use a 50MHz DPLL by choice
 968                  */
 969                 unsigned int f_low, f_high;
 970                 int dpll, adjust;
 971
 972                 /* Compute DPLL */
 973                 dpll = (ppi[0]->udma_mask & 0xC0) ? 3 : 2;
 974
 975                 f_low = (MHz[clock_slot] * 48) / MHz[dpll];
 976                 f_high = f_low + 2;
 977                 if (clock_slot > 1)
 978                         f_high += 2;
 979
 980                 /* Select the DPLL clock. */
 981                 pci_write_config_byte(dev, 0x5b, 0x21);
 982                 pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low | 0x100);
 983
 984                 for(adjust = 0; adjust < 8; adjust++) {
 985                         if (hpt37x_calibrate_dpll(dev))
 986                                 break;
 987                         /* See if it'll settle at a fractionally different clock */
 988                         if (adjust & 1)
 989                                 f_low -= adjust >> 1;
 990                         else
 991                                 f_high += adjust >> 1;
 992                         pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low | 0x100);
 993                 }
 994                 if (adjust == 8) {
 995                         printk(KERN_ERR "pata_hpt37x: DPLL did not stabilize!\n");
 996                         return -ENODEV;
 997                 }
 998                 if (dpll == 3)
 999                         private_data = (void *)hpt37x_timings_66;
1000                 else
1001                         private_data = (void *)hpt37x_timings_50;
1002
1003                 printk(KERN_INFO "pata_hpt37x: bus clock %dMHz, using %dMHz DPLL.\n",
1004                        MHz[clock_slot], MHz[dpll]);
1005         } else {
1006                 private_data = (void *)chip_table->clocks[clock_slot];
1007                 /*
1008                  *      Perform a final fixup. Note that we will have used the
1009                  *      DPLL on the HPT372 which means we don't have to worry
1010                  *      about lack of UDMA133 support on lower clocks
1011                  */
1012
1013                 if (clock_slot < 2 && ppi[0] == &info_hpt370)
1014                         ppi[0] = &info_hpt370_33;
1015                 if (clock_slot < 2 && ppi[0] == &info_hpt370a)
1016                         ppi[0] = &info_hpt370a_33;
1017                 printk(KERN_INFO "pata_hpt37x: %s using %dMHz bus clock.\n",
1018                        chip_table->name, MHz[clock_slot]);
1019         }
1020
1021         /* Now kick off ATA set up */
1022         return ata_pci_sff_init_one(dev, ppi, &hpt37x_sht, private_data);
1023 }
1024
1025 static const struct pci_device_id hpt37x[] = {
1026         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT366), },
1027         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT371), },
1028         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT372), },
1029         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT374), },
1030         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT302), },
1031
1032         { },
1033 };
1034
1035 static struct pci_driver hpt37x_pci_driver = {
1036         .name           = DRV_NAME,
1037         .id_table       = hpt37x,
1038         .probe          = hpt37x_init_one,
1039         .remove         = ata_pci_remove_one
1040 };
1041
1042 static int __init hpt37x_init(void)
1043 {
1044         return pci_register_driver(&hpt37x_pci_driver);
1045 }
1046
1047 static void __exit hpt37x_exit(void)
1048 {
1049         pci_unregister_driver(&hpt37x_pci_driver);
1050 }
1051
1052 MODULE_AUTHOR("Alan Cox");
1053 MODULE_DESCRIPTION("low-level driver for the Highpoint HPT37x/30x");
1054 MODULE_LICENSE("GPL");
1055 MODULE_DEVICE_TABLE(pci, hpt37x);
1056 MODULE_VERSION(DRV_VERSION);
1057
1058 module_init(hpt37x_init);
1059 module_exit(hpt37x_exit);