qeth: layer 3 do not allow to change mac address
[linux-2.6] / 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_pci_default_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_pci_default_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_std_prereset(link, deadline);
342 }
343
344 /**
345  *      hpt37x_error_handler    -       reset the hpt374
346  *      @ap: ATA port to reset
347  *
348  *      Perform probe for HPT37x, except for HPT374 channel 2
349  */
350
351 static void hpt37x_error_handler(struct ata_port *ap)
352 {
353         ata_bmdma_drive_eh(ap, hpt37x_pre_reset, ata_std_softreset, NULL, ata_std_postreset);
354 }
355
356 static int hpt374_pre_reset(struct ata_link *link, unsigned long deadline)
357 {
358         static const struct pci_bits hpt37x_enable_bits[] = {
359                 { 0x50, 1, 0x04, 0x04 },
360                 { 0x54, 1, 0x04, 0x04 }
361         };
362         u16 mcr3;
363         u8 ata66;
364         struct ata_port *ap = link->ap;
365         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
366         unsigned int mcrbase = 0x50 + 4 * ap->port_no;
367
368         if (!pci_test_config_bits(pdev, &hpt37x_enable_bits[ap->port_no]))
369                 return -ENOENT;
370
371         /* Do the extra channel work */
372         pci_read_config_word(pdev, mcrbase + 2, &mcr3);
373         /* Set bit 15 of 0x52 to enable TCBLID as input
374          */
375         pci_write_config_word(pdev, mcrbase + 2, mcr3 | 0x8000);
376         pci_read_config_byte(pdev, 0x5A, &ata66);
377         /* Reset TCBLID/FCBLID to output */
378         pci_write_config_word(pdev, mcrbase + 2, mcr3);
379
380         if (ata66 & (2 >> ap->port_no))
381                 ap->cbl = ATA_CBL_PATA40;
382         else
383                 ap->cbl = ATA_CBL_PATA80;
384
385         /* Reset the state machine */
386         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
387         udelay(100);
388
389         return ata_std_prereset(link, deadline);
390 }
391
392 /**
393  *      hpt374_error_handler    -       reset the hpt374
394  *      @classes:
395  *
396  *      The 374 cable detect is a little different due to the extra
397  *      channels. The function 0 channels work like usual but function 1
398  *      is special
399  */
400
401 static void hpt374_error_handler(struct ata_port *ap)
402 {
403         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
404
405         if (!(PCI_FUNC(pdev->devfn) & 1))
406                 hpt37x_error_handler(ap);
407         else
408                 ata_bmdma_drive_eh(ap, hpt374_pre_reset, ata_std_softreset, NULL, ata_std_postreset);
409 }
410
411 /**
412  *      hpt370_set_piomode              -       PIO setup
413  *      @ap: ATA interface
414  *      @adev: device on the interface
415  *
416  *      Perform PIO mode setup.
417  */
418
419 static void hpt370_set_piomode(struct ata_port *ap, struct ata_device *adev)
420 {
421         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
422         u32 addr1, addr2;
423         u32 reg;
424         u32 mode;
425         u8 fast;
426
427         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
428         addr2 = 0x51 + 4 * ap->port_no;
429
430         /* Fast interrupt prediction disable, hold off interrupt disable */
431         pci_read_config_byte(pdev, addr2, &fast);
432         fast &= ~0x02;
433         fast |= 0x01;
434         pci_write_config_byte(pdev, addr2, fast);
435
436         pci_read_config_dword(pdev, addr1, &reg);
437         mode = hpt37x_find_mode(ap, adev->pio_mode);
438         mode &= ~0x8000000;     /* No FIFO in PIO */
439         mode &= ~0x30070000;    /* Leave config bits alone */
440         reg &= 0x30070000;      /* Strip timing bits */
441         pci_write_config_dword(pdev, addr1, reg | mode);
442 }
443
444 /**
445  *      hpt370_set_dmamode              -       DMA timing setup
446  *      @ap: ATA interface
447  *      @adev: Device being configured
448  *
449  *      Set up the channel for MWDMA or UDMA modes. Much the same as with
450  *      PIO, load the mode number and then set MWDMA or UDMA flag.
451  */
452
453 static void hpt370_set_dmamode(struct ata_port *ap, struct ata_device *adev)
454 {
455         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
456         u32 addr1, addr2;
457         u32 reg;
458         u32 mode;
459         u8 fast;
460
461         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
462         addr2 = 0x51 + 4 * ap->port_no;
463
464         /* Fast interrupt prediction disable, hold off interrupt disable */
465         pci_read_config_byte(pdev, addr2, &fast);
466         fast &= ~0x02;
467         fast |= 0x01;
468         pci_write_config_byte(pdev, addr2, fast);
469
470         pci_read_config_dword(pdev, addr1, &reg);
471         mode = hpt37x_find_mode(ap, adev->dma_mode);
472         mode |= 0x8000000;      /* FIFO in MWDMA or UDMA */
473         mode &= ~0xC0000000;    /* Leave config bits alone */
474         reg &= 0xC0000000;      /* Strip timing bits */
475         pci_write_config_dword(pdev, addr1, reg | mode);
476 }
477
478 /**
479  *      hpt370_bmdma_start              -       DMA engine begin
480  *      @qc: ATA command
481  *
482  *      The 370 and 370A want us to reset the DMA engine each time we
483  *      use it. The 372 and later are fine.
484  */
485
486 static void hpt370_bmdma_start(struct ata_queued_cmd *qc)
487 {
488         struct ata_port *ap = qc->ap;
489         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
490         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
491         udelay(10);
492         ata_bmdma_start(qc);
493 }
494
495 /**
496  *      hpt370_bmdma_end                -       DMA engine stop
497  *      @qc: ATA command
498  *
499  *      Work around the HPT370 DMA engine.
500  */
501
502 static void hpt370_bmdma_stop(struct ata_queued_cmd *qc)
503 {
504         struct ata_port *ap = qc->ap;
505         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
506         u8 dma_stat = ioread8(ap->ioaddr.bmdma_addr + 2);
507         u8 dma_cmd;
508         void __iomem *bmdma = ap->ioaddr.bmdma_addr;
509
510         if (dma_stat & 0x01) {
511                 udelay(20);
512                 dma_stat = ioread8(bmdma + 2);
513         }
514         if (dma_stat & 0x01) {
515                 /* Clear the engine */
516                 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
517                 udelay(10);
518                 /* Stop DMA */
519                 dma_cmd = ioread8(bmdma );
520                 iowrite8(dma_cmd & 0xFE, bmdma);
521                 /* Clear Error */
522                 dma_stat = ioread8(bmdma + 2);
523                 iowrite8(dma_stat | 0x06 , bmdma + 2);
524                 /* Clear the engine */
525                 pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
526                 udelay(10);
527         }
528         ata_bmdma_stop(qc);
529 }
530
531 /**
532  *      hpt372_set_piomode              -       PIO setup
533  *      @ap: ATA interface
534  *      @adev: device on the interface
535  *
536  *      Perform PIO mode setup.
537  */
538
539 static void hpt372_set_piomode(struct ata_port *ap, struct ata_device *adev)
540 {
541         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
542         u32 addr1, addr2;
543         u32 reg;
544         u32 mode;
545         u8 fast;
546
547         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
548         addr2 = 0x51 + 4 * ap->port_no;
549
550         /* Fast interrupt prediction disable, hold off interrupt disable */
551         pci_read_config_byte(pdev, addr2, &fast);
552         fast &= ~0x07;
553         pci_write_config_byte(pdev, addr2, fast);
554
555         pci_read_config_dword(pdev, addr1, &reg);
556         mode = hpt37x_find_mode(ap, adev->pio_mode);
557
558         printk("Find mode for %d reports %X\n", adev->pio_mode, mode);
559         mode &= ~0x80000000;    /* No FIFO in PIO */
560         mode &= ~0x30070000;    /* Leave config bits alone */
561         reg &= 0x30070000;      /* Strip timing bits */
562         pci_write_config_dword(pdev, addr1, reg | mode);
563 }
564
565 /**
566  *      hpt372_set_dmamode              -       DMA timing setup
567  *      @ap: ATA interface
568  *      @adev: Device being configured
569  *
570  *      Set up the channel for MWDMA or UDMA modes. Much the same as with
571  *      PIO, load the mode number and then set MWDMA or UDMA flag.
572  */
573
574 static void hpt372_set_dmamode(struct ata_port *ap, struct ata_device *adev)
575 {
576         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
577         u32 addr1, addr2;
578         u32 reg;
579         u32 mode;
580         u8 fast;
581
582         addr1 = 0x40 + 4 * (adev->devno + 2 * ap->port_no);
583         addr2 = 0x51 + 4 * ap->port_no;
584
585         /* Fast interrupt prediction disable, hold off interrupt disable */
586         pci_read_config_byte(pdev, addr2, &fast);
587         fast &= ~0x07;
588         pci_write_config_byte(pdev, addr2, fast);
589
590         pci_read_config_dword(pdev, addr1, &reg);
591         mode = hpt37x_find_mode(ap, adev->dma_mode);
592         printk("Find mode for DMA %d reports %X\n", adev->dma_mode, mode);
593         mode &= ~0xC0000000;    /* Leave config bits alone */
594         mode |= 0x80000000;     /* FIFO in MWDMA or UDMA */
595         reg &= 0xC0000000;      /* Strip timing bits */
596         pci_write_config_dword(pdev, addr1, reg | mode);
597 }
598
599 /**
600  *      hpt37x_bmdma_end                -       DMA engine stop
601  *      @qc: ATA command
602  *
603  *      Clean up after the HPT372 and later DMA engine
604  */
605
606 static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
607 {
608         struct ata_port *ap = qc->ap;
609         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
610         int mscreg = 0x50 + 4 * ap->port_no;
611         u8 bwsr_stat, msc_stat;
612
613         pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
614         pci_read_config_byte(pdev, mscreg, &msc_stat);
615         if (bwsr_stat & (1 << ap->port_no))
616                 pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
617         ata_bmdma_stop(qc);
618 }
619
620
621 static struct scsi_host_template hpt37x_sht = {
622         .module                 = THIS_MODULE,
623         .name                   = DRV_NAME,
624         .ioctl                  = ata_scsi_ioctl,
625         .queuecommand           = ata_scsi_queuecmd,
626         .can_queue              = ATA_DEF_QUEUE,
627         .this_id                = ATA_SHT_THIS_ID,
628         .sg_tablesize           = LIBATA_MAX_PRD,
629         .cmd_per_lun            = ATA_SHT_CMD_PER_LUN,
630         .emulated               = ATA_SHT_EMULATED,
631         .use_clustering         = ATA_SHT_USE_CLUSTERING,
632         .proc_name              = DRV_NAME,
633         .dma_boundary           = ATA_DMA_BOUNDARY,
634         .slave_configure        = ata_scsi_slave_config,
635         .slave_destroy          = ata_scsi_slave_destroy,
636         .bios_param             = ata_std_bios_param,
637 };
638
639 /*
640  *      Configuration for HPT370
641  */
642
643 static struct ata_port_operations hpt370_port_ops = {
644         .set_piomode    = hpt370_set_piomode,
645         .set_dmamode    = hpt370_set_dmamode,
646         .mode_filter    = hpt370_filter,
647
648         .tf_load        = ata_tf_load,
649         .tf_read        = ata_tf_read,
650         .check_status   = ata_check_status,
651         .exec_command   = ata_exec_command,
652         .dev_select     = ata_std_dev_select,
653
654         .freeze         = ata_bmdma_freeze,
655         .thaw           = ata_bmdma_thaw,
656         .error_handler  = hpt37x_error_handler,
657         .post_internal_cmd = ata_bmdma_post_internal_cmd,
658
659         .bmdma_setup    = ata_bmdma_setup,
660         .bmdma_start    = hpt370_bmdma_start,
661         .bmdma_stop     = hpt370_bmdma_stop,
662         .bmdma_status   = ata_bmdma_status,
663
664         .qc_prep        = ata_qc_prep,
665         .qc_issue       = ata_qc_issue_prot,
666
667         .data_xfer      = ata_data_xfer,
668
669         .irq_handler    = ata_interrupt,
670         .irq_clear      = ata_bmdma_irq_clear,
671         .irq_on         = ata_irq_on,
672
673         .port_start     = ata_sff_port_start,
674 };
675
676 /*
677  *      Configuration for HPT370A. Close to 370 but less filters
678  */
679
680 static struct ata_port_operations hpt370a_port_ops = {
681         .set_piomode    = hpt370_set_piomode,
682         .set_dmamode    = hpt370_set_dmamode,
683         .mode_filter    = hpt370a_filter,
684
685         .tf_load        = ata_tf_load,
686         .tf_read        = ata_tf_read,
687         .check_status   = ata_check_status,
688         .exec_command   = ata_exec_command,
689         .dev_select     = ata_std_dev_select,
690
691         .freeze         = ata_bmdma_freeze,
692         .thaw           = ata_bmdma_thaw,
693         .error_handler  = hpt37x_error_handler,
694         .post_internal_cmd = ata_bmdma_post_internal_cmd,
695
696         .bmdma_setup    = ata_bmdma_setup,
697         .bmdma_start    = hpt370_bmdma_start,
698         .bmdma_stop     = hpt370_bmdma_stop,
699         .bmdma_status   = ata_bmdma_status,
700
701         .qc_prep        = ata_qc_prep,
702         .qc_issue       = ata_qc_issue_prot,
703
704         .data_xfer      = ata_data_xfer,
705
706         .irq_handler    = ata_interrupt,
707         .irq_clear      = ata_bmdma_irq_clear,
708         .irq_on         = ata_irq_on,
709
710         .port_start     = ata_sff_port_start,
711 };
712
713 /*
714  *      Configuration for HPT372, HPT371, HPT302. Slightly different PIO
715  *      and DMA mode setting functionality.
716  */
717
718 static struct ata_port_operations hpt372_port_ops = {
719         .set_piomode    = hpt372_set_piomode,
720         .set_dmamode    = hpt372_set_dmamode,
721         .mode_filter    = ata_pci_default_filter,
722
723         .tf_load        = ata_tf_load,
724         .tf_read        = ata_tf_read,
725         .check_status   = ata_check_status,
726         .exec_command   = ata_exec_command,
727         .dev_select     = ata_std_dev_select,
728
729         .freeze         = ata_bmdma_freeze,
730         .thaw           = ata_bmdma_thaw,
731         .error_handler  = hpt37x_error_handler,
732         .post_internal_cmd = ata_bmdma_post_internal_cmd,
733
734         .bmdma_setup    = ata_bmdma_setup,
735         .bmdma_start    = ata_bmdma_start,
736         .bmdma_stop     = hpt37x_bmdma_stop,
737         .bmdma_status   = ata_bmdma_status,
738
739         .qc_prep        = ata_qc_prep,
740         .qc_issue       = ata_qc_issue_prot,
741
742         .data_xfer      = ata_data_xfer,
743
744         .irq_handler    = ata_interrupt,
745         .irq_clear      = ata_bmdma_irq_clear,
746         .irq_on         = ata_irq_on,
747
748         .port_start     = ata_sff_port_start,
749 };
750
751 /*
752  *      Configuration for HPT374. Mode setting works like 372 and friends
753  *      but we have a different cable detection procedure.
754  */
755
756 static struct ata_port_operations hpt374_port_ops = {
757         .set_piomode    = hpt372_set_piomode,
758         .set_dmamode    = hpt372_set_dmamode,
759         .mode_filter    = ata_pci_default_filter,
760
761         .tf_load        = ata_tf_load,
762         .tf_read        = ata_tf_read,
763         .check_status   = ata_check_status,
764         .exec_command   = ata_exec_command,
765         .dev_select     = ata_std_dev_select,
766
767         .freeze         = ata_bmdma_freeze,
768         .thaw           = ata_bmdma_thaw,
769         .error_handler  = hpt374_error_handler,
770         .post_internal_cmd = ata_bmdma_post_internal_cmd,
771
772         .bmdma_setup    = ata_bmdma_setup,
773         .bmdma_start    = ata_bmdma_start,
774         .bmdma_stop     = hpt37x_bmdma_stop,
775         .bmdma_status   = ata_bmdma_status,
776
777         .qc_prep        = ata_qc_prep,
778         .qc_issue       = ata_qc_issue_prot,
779
780         .data_xfer      = ata_data_xfer,
781
782         .irq_handler    = ata_interrupt,
783         .irq_clear      = ata_bmdma_irq_clear,
784         .irq_on         = ata_irq_on,
785
786         .port_start     = ata_sff_port_start,
787 };
788
789 /**
790  *      htp37x_clock_slot       -       Turn timing to PC clock entry
791  *      @freq: Reported frequency timing
792  *      @base: Base timing
793  *
794  *      Turn the timing data intoa clock slot (0 for 33, 1 for 40, 2 for 50
795  *      and 3 for 66Mhz)
796  */
797
798 static int hpt37x_clock_slot(unsigned int freq, unsigned int base)
799 {
800         unsigned int f = (base * freq) / 192;   /* Mhz */
801         if (f < 40)
802                 return 0;       /* 33Mhz slot */
803         if (f < 45)
804                 return 1;       /* 40Mhz slot */
805         if (f < 55)
806                 return 2;       /* 50Mhz slot */
807         return 3;               /* 60Mhz slot */
808 }
809
810 /**
811  *      hpt37x_calibrate_dpll           -       Calibrate the DPLL loop
812  *      @dev: PCI device
813  *
814  *      Perform a calibration cycle on the HPT37x DPLL. Returns 1 if this
815  *      succeeds
816  */
817
818 static int hpt37x_calibrate_dpll(struct pci_dev *dev)
819 {
820         u8 reg5b;
821         u32 reg5c;
822         int tries;
823
824         for(tries = 0; tries < 0x5000; tries++) {
825                 udelay(50);
826                 pci_read_config_byte(dev, 0x5b, &reg5b);
827                 if (reg5b & 0x80) {
828                         /* See if it stays set */
829                         for(tries = 0; tries < 0x1000; tries ++) {
830                                 pci_read_config_byte(dev, 0x5b, &reg5b);
831                                 /* Failed ? */
832                                 if ((reg5b & 0x80) == 0)
833                                         return 0;
834                         }
835                         /* Turn off tuning, we have the DPLL set */
836                         pci_read_config_dword(dev, 0x5c, &reg5c);
837                         pci_write_config_dword(dev, 0x5c, reg5c & ~ 0x100);
838                         return 1;
839                 }
840         }
841         /* Never went stable */
842         return 0;
843 }
844
845 static u32 hpt374_read_freq(struct pci_dev *pdev)
846 {
847         u32 freq;
848         unsigned long io_base = pci_resource_start(pdev, 4);
849         if (PCI_FUNC(pdev->devfn) & 1) {
850                 struct pci_dev *pdev_0;
851
852                 pdev_0 = pci_get_slot(pdev->bus, pdev->devfn - 1);
853                 /* Someone hot plugged the controller on us ? */
854                 if (pdev_0 == NULL)
855                         return 0;
856                 io_base = pci_resource_start(pdev_0, 4);
857                 freq = inl(io_base + 0x90);
858                 pci_dev_put(pdev_0);
859         } else
860                 freq = inl(io_base + 0x90);
861         return freq;
862 }
863
864 /**
865  *      hpt37x_init_one         -       Initialise an HPT37X/302
866  *      @dev: PCI device
867  *      @id: Entry in match table
868  *
869  *      Initialise an HPT37x device. There are some interesting complications
870  *      here. Firstly the chip may report 366 and be one of several variants.
871  *      Secondly all the timings depend on the clock for the chip which we must
872  *      detect and look up
873  *
874  *      This is the known chip mappings. It may be missing a couple of later
875  *      releases.
876  *
877  *      Chip version            PCI             Rev     Notes
878  *      HPT366                  4 (HPT366)      0       Other driver
879  *      HPT366                  4 (HPT366)      1       Other driver
880  *      HPT368                  4 (HPT366)      2       Other driver
881  *      HPT370                  4 (HPT366)      3       UDMA100
882  *      HPT370A                 4 (HPT366)      4       UDMA100
883  *      HPT372                  4 (HPT366)      5       UDMA133 (1)
884  *      HPT372N                 4 (HPT366)      6       Other driver
885  *      HPT372A                 5 (HPT372)      1       UDMA133 (1)
886  *      HPT372N                 5 (HPT372)      2       Other driver
887  *      HPT302                  6 (HPT302)      1       UDMA133
888  *      HPT302N                 6 (HPT302)      2       Other driver
889  *      HPT371                  7 (HPT371)      *       UDMA133
890  *      HPT374                  8 (HPT374)      *       UDMA133 4 channel
891  *      HPT372N                 9 (HPT372N)     *       Other driver
892  *
893  *      (1) UDMA133 support depends on the bus clock
894  */
895
896 static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
897 {
898         /* HPT370 - UDMA100 */
899         static const struct ata_port_info info_hpt370 = {
900                 .sht = &hpt37x_sht,
901                 .flags = ATA_FLAG_SLAVE_POSS,
902                 .pio_mask = 0x1f,
903                 .mwdma_mask = 0x07,
904                 .udma_mask = ATA_UDMA5,
905                 .port_ops = &hpt370_port_ops
906         };
907         /* HPT370A - UDMA100 */
908         static const struct ata_port_info info_hpt370a = {
909                 .sht = &hpt37x_sht,
910                 .flags = ATA_FLAG_SLAVE_POSS,
911                 .pio_mask = 0x1f,
912                 .mwdma_mask = 0x07,
913                 .udma_mask = ATA_UDMA5,
914                 .port_ops = &hpt370a_port_ops
915         };
916         /* HPT370 - UDMA100 */
917         static const struct ata_port_info info_hpt370_33 = {
918                 .sht = &hpt37x_sht,
919                 .flags = ATA_FLAG_SLAVE_POSS,
920                 .pio_mask = 0x1f,
921                 .mwdma_mask = 0x07,
922                 .udma_mask = ATA_UDMA5,
923                 .port_ops = &hpt370_port_ops
924         };
925         /* HPT370A - UDMA100 */
926         static const struct ata_port_info info_hpt370a_33 = {
927                 .sht = &hpt37x_sht,
928                 .flags = ATA_FLAG_SLAVE_POSS,
929                 .pio_mask = 0x1f,
930                 .mwdma_mask = 0x07,
931                 .udma_mask = ATA_UDMA5,
932                 .port_ops = &hpt370a_port_ops
933         };
934         /* HPT371, 372 and friends - UDMA133 */
935         static const struct ata_port_info info_hpt372 = {
936                 .sht = &hpt37x_sht,
937                 .flags = ATA_FLAG_SLAVE_POSS,
938                 .pio_mask = 0x1f,
939                 .mwdma_mask = 0x07,
940                 .udma_mask = ATA_UDMA6,
941                 .port_ops = &hpt372_port_ops
942         };
943         /* HPT374 - UDMA100 */
944         static const struct ata_port_info info_hpt374 = {
945                 .sht = &hpt37x_sht,
946                 .flags = ATA_FLAG_SLAVE_POSS,
947                 .pio_mask = 0x1f,
948                 .mwdma_mask = 0x07,
949                 .udma_mask = ATA_UDMA5,
950                 .port_ops = &hpt374_port_ops
951         };
952
953         static const int MHz[4] = { 33, 40, 50, 66 };
954         const struct ata_port_info *port;
955         void *private_data = NULL;
956         struct ata_port_info port_info;
957         const struct ata_port_info *ppi[] = { &port_info, NULL };
958
959         u8 irqmask;
960         u32 class_rev;
961         u8 mcr1;
962         u32 freq;
963         int prefer_dpll = 1;
964
965         unsigned long iobase = pci_resource_start(dev, 4);
966
967         const struct hpt_chip *chip_table;
968         int clock_slot;
969
970         pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
971         class_rev &= 0xFF;
972
973         if (dev->device == PCI_DEVICE_ID_TTI_HPT366) {
974                 /* May be a later chip in disguise. Check */
975                 /* Older chips are in the HPT366 driver. Ignore them */
976                 if (class_rev < 3)
977                         return -ENODEV;
978                 /* N series chips have their own driver. Ignore */
979                 if (class_rev == 6)
980                         return -ENODEV;
981
982                 switch(class_rev) {
983                         case 3:
984                                 port = &info_hpt370;
985                                 chip_table = &hpt370;
986                                 prefer_dpll = 0;
987                                 break;
988                         case 4:
989                                 port = &info_hpt370a;
990                                 chip_table = &hpt370a;
991                                 prefer_dpll = 0;
992                                 break;
993                         case 5:
994                                 port = &info_hpt372;
995                                 chip_table = &hpt372;
996                                 break;
997                         default:
998                                 printk(KERN_ERR "pata_hpt37x: Unknown HPT366 subtype please report (%d).\n", class_rev);
999                                 return -ENODEV;
1000                 }
1001         } else {
1002                 switch(dev->device) {
1003                         case PCI_DEVICE_ID_TTI_HPT372:
1004                                 /* 372N if rev >= 2*/
1005                                 if (class_rev >= 2)
1006                                         return -ENODEV;
1007                                 port = &info_hpt372;
1008                                 chip_table = &hpt372a;
1009                                 break;
1010                         case PCI_DEVICE_ID_TTI_HPT302:
1011                                 /* 302N if rev > 1 */
1012                                 if (class_rev > 1)
1013                                         return -ENODEV;
1014                                 port = &info_hpt372;
1015                                 /* Check this */
1016                                 chip_table = &hpt302;
1017                                 break;
1018                         case PCI_DEVICE_ID_TTI_HPT371:
1019                                 if (class_rev > 1)
1020                                         return -ENODEV;
1021                                 port = &info_hpt372;
1022                                 chip_table = &hpt371;
1023                                 /* Single channel device, master is not present
1024                                    but the BIOS (or us for non x86) must mark it
1025                                    absent */
1026                                 pci_read_config_byte(dev, 0x50, &mcr1);
1027                                 mcr1 &= ~0x04;
1028                                 pci_write_config_byte(dev, 0x50, mcr1);
1029                                 break;
1030                         case PCI_DEVICE_ID_TTI_HPT374:
1031                                 chip_table = &hpt374;
1032                                 port = &info_hpt374;
1033                                 break;
1034                         default:
1035                                 printk(KERN_ERR "pata_hpt37x: PCI table is bogus please report (%d).\n", dev->device);
1036                                 return -ENODEV;
1037                 }
1038         }
1039         /* Ok so this is a chip we support */
1040
1041         pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
1042         pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
1043         pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
1044         pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
1045
1046         pci_read_config_byte(dev, 0x5A, &irqmask);
1047         irqmask &= ~0x10;
1048         pci_write_config_byte(dev, 0x5a, irqmask);
1049
1050         /*
1051          * default to pci clock. make sure MA15/16 are set to output
1052          * to prevent drives having problems with 40-pin cables. Needed
1053          * for some drives such as IBM-DTLA which will not enter ready
1054          * state on reset when PDIAG is a input.
1055          */
1056
1057         pci_write_config_byte(dev, 0x5b, 0x23);
1058
1059         /*
1060          * HighPoint does this for HPT372A.
1061          * NOTE: This register is only writeable via I/O space.
1062          */
1063         if (chip_table == &hpt372a)
1064                 outb(0x0e, iobase + 0x9c);
1065
1066         /* Some devices do not let this value be accessed via PCI space
1067            according to the old driver. In addition we must use the value
1068            from FN 0 on the HPT374 */
1069
1070         if (chip_table == &hpt374) {
1071                 freq = hpt374_read_freq(dev);
1072                 if (freq == 0)
1073                         return -ENODEV;
1074         } else
1075                 freq = inl(iobase + 0x90);
1076
1077         if ((freq >> 12) != 0xABCDE) {
1078                 int i;
1079                 u8 sr;
1080                 u32 total = 0;
1081
1082                 printk(KERN_WARNING "pata_hpt37x: BIOS has not set timing clocks.\n");
1083
1084                 /* This is the process the HPT371 BIOS is reported to use */
1085                 for(i = 0; i < 128; i++) {
1086                         pci_read_config_byte(dev, 0x78, &sr);
1087                         total += sr & 0x1FF;
1088                         udelay(15);
1089                 }
1090                 freq = total / 128;
1091         }
1092         freq &= 0x1FF;
1093
1094         /*
1095          *      Turn the frequency check into a band and then find a timing
1096          *      table to match it.
1097          */
1098
1099         clock_slot = hpt37x_clock_slot(freq, chip_table->base);
1100         if (chip_table->clocks[clock_slot] == NULL || prefer_dpll) {
1101                 /*
1102                  *      We need to try PLL mode instead
1103                  *
1104                  *      For non UDMA133 capable devices we should
1105                  *      use a 50MHz DPLL by choice
1106                  */
1107                 unsigned int f_low, f_high;
1108                 int dpll, adjust;
1109
1110                 /* Compute DPLL */
1111                 dpll = (port->udma_mask & 0xC0) ? 3 : 2;
1112
1113                 f_low = (MHz[clock_slot] * 48) / MHz[dpll];
1114                 f_high = f_low + 2;
1115                 if (clock_slot > 1)
1116                         f_high += 2;
1117
1118                 /* Select the DPLL clock. */
1119                 pci_write_config_byte(dev, 0x5b, 0x21);
1120                 pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low | 0x100);
1121
1122                 for(adjust = 0; adjust < 8; adjust++) {
1123                         if (hpt37x_calibrate_dpll(dev))
1124                                 break;
1125                         /* See if it'll settle at a fractionally different clock */
1126                         if (adjust & 1)
1127                                 f_low -= adjust >> 1;
1128                         else
1129                                 f_high += adjust >> 1;
1130                         pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low | 0x100);
1131                 }
1132                 if (adjust == 8) {
1133                         printk(KERN_ERR "pata_hpt37x: DPLL did not stabilize!\n");
1134                         return -ENODEV;
1135                 }
1136                 if (dpll == 3)
1137                         private_data = (void *)hpt37x_timings_66;
1138                 else
1139                         private_data = (void *)hpt37x_timings_50;
1140
1141                 printk(KERN_INFO "pata_hpt37x: bus clock %dMHz, using %dMHz DPLL.\n",
1142                        MHz[clock_slot], MHz[dpll]);
1143         } else {
1144                 private_data = (void *)chip_table->clocks[clock_slot];
1145                 /*
1146                  *      Perform a final fixup. Note that we will have used the
1147                  *      DPLL on the HPT372 which means we don't have to worry
1148                  *      about lack of UDMA133 support on lower clocks
1149                  */
1150
1151                 if (clock_slot < 2 && port == &info_hpt370)
1152                         port = &info_hpt370_33;
1153                 if (clock_slot < 2 && port == &info_hpt370a)
1154                         port = &info_hpt370a_33;
1155                 printk(KERN_INFO "pata_hpt37x: %s using %dMHz bus clock.\n",
1156                        chip_table->name, MHz[clock_slot]);
1157         }
1158
1159         /* Now kick off ATA set up */
1160         port_info = *port;
1161         port_info.private_data = private_data;
1162
1163         return ata_pci_init_one(dev, ppi);
1164 }
1165
1166 static const struct pci_device_id hpt37x[] = {
1167         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT366), },
1168         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT371), },
1169         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT372), },
1170         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT374), },
1171         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT302), },
1172
1173         { },
1174 };
1175
1176 static struct pci_driver hpt37x_pci_driver = {
1177         .name           = DRV_NAME,
1178         .id_table       = hpt37x,
1179         .probe          = hpt37x_init_one,
1180         .remove         = ata_pci_remove_one
1181 };
1182
1183 static int __init hpt37x_init(void)
1184 {
1185         return pci_register_driver(&hpt37x_pci_driver);
1186 }
1187
1188 static void __exit hpt37x_exit(void)
1189 {
1190         pci_unregister_driver(&hpt37x_pci_driver);
1191 }
1192
1193 MODULE_AUTHOR("Alan Cox");
1194 MODULE_DESCRIPTION("low-level driver for the Highpoint HPT37x/30x");
1195 MODULE_LICENSE("GPL");
1196 MODULE_DEVICE_TABLE(pci, hpt37x);
1197 MODULE_VERSION(DRV_VERSION);
1198
1199 module_init(hpt37x_init);
1200 module_exit(hpt37x_exit);