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