ide: add missing ide_rate_filter() calls to ->speedproc()-s
[safe/jmp/linux-2.6] / drivers / ide / pci / via82cxxx.c
1 /*
2  *
3  * Version 3.47
4  *
5  * VIA IDE driver for Linux. Supported southbridges:
6  *
7  *   vt82c576, vt82c586, vt82c586a, vt82c586b, vt82c596a, vt82c596b,
8  *   vt82c686, vt82c686a, vt82c686b, vt8231, vt8233, vt8233c, vt8233a,
9  *   vt8235, vt8237, vt8237a
10  *
11  * Copyright (c) 2000-2002 Vojtech Pavlik
12  * Copyright (c) 2007 Bartlomiej Zolnierkiewicz
13  *
14  * Based on the work of:
15  *      Michel Aubry
16  *      Jeff Garzik
17  *      Andre Hedrick
18  *
19  * Documentation:
20  *      Obsolete device documentation publically available from via.com.tw
21  *      Current device documentation available under NDA only
22  */
23
24 /*
25  * This program is free software; you can redistribute it and/or modify it
26  * under the terms of the GNU General Public License version 2 as published by
27  * the Free Software Foundation.
28  */
29
30 #include <linux/module.h>
31 #include <linux/kernel.h>
32 #include <linux/ioport.h>
33 #include <linux/blkdev.h>
34 #include <linux/pci.h>
35 #include <linux/init.h>
36 #include <linux/ide.h>
37 #include <linux/dmi.h>
38
39 #include <asm/io.h>
40
41 #ifdef CONFIG_PPC_CHRP
42 #include <asm/processor.h>
43 #endif
44
45 #include "ide-timing.h"
46
47 #define VIA_IDE_ENABLE          0x40
48 #define VIA_IDE_CONFIG          0x41
49 #define VIA_FIFO_CONFIG         0x43
50 #define VIA_MISC_1              0x44
51 #define VIA_MISC_2              0x45
52 #define VIA_MISC_3              0x46
53 #define VIA_DRIVE_TIMING        0x48
54 #define VIA_8BIT_TIMING         0x4e
55 #define VIA_ADDRESS_SETUP       0x4c
56 #define VIA_UDMA_TIMING         0x50
57
58 #define VIA_BAD_PREQ            0x01 /* Crashes if PREQ# till DDACK# set */
59 #define VIA_BAD_CLK66           0x02 /* 66 MHz clock doesn't work correctly */
60 #define VIA_SET_FIFO            0x04 /* Needs to have FIFO split set */
61 #define VIA_NO_UNMASK           0x08 /* Doesn't work with IRQ unmasking on */
62 #define VIA_BAD_ID              0x10 /* Has wrong vendor ID (0x1107) */
63 #define VIA_BAD_AST             0x20 /* Don't touch Address Setup Timing */
64
65 /*
66  * VIA SouthBridge chips.
67  */
68
69 static struct via_isa_bridge {
70         char *name;
71         u16 id;
72         u8 rev_min;
73         u8 rev_max;
74         u8 udma_mask;
75         u8 flags;
76 } via_isa_bridges[] = {
77         { "vx800",      PCI_DEVICE_ID_VIA_VX800,    0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
78         { "cx700",      PCI_DEVICE_ID_VIA_CX700,    0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
79         { "vt8237s",    PCI_DEVICE_ID_VIA_8237S,    0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
80         { "vt6410",     PCI_DEVICE_ID_VIA_6410,     0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
81         { "vt8251",     PCI_DEVICE_ID_VIA_8251,     0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
82         { "vt8237",     PCI_DEVICE_ID_VIA_8237,     0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
83         { "vt8237a",    PCI_DEVICE_ID_VIA_8237A,    0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
84         { "vt8235",     PCI_DEVICE_ID_VIA_8235,     0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
85         { "vt8233a",    PCI_DEVICE_ID_VIA_8233A,    0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST },
86         { "vt8233c",    PCI_DEVICE_ID_VIA_8233C_0,  0x00, 0x2f, ATA_UDMA5, },
87         { "vt8233",     PCI_DEVICE_ID_VIA_8233_0,   0x00, 0x2f, ATA_UDMA5, },
88         { "vt8231",     PCI_DEVICE_ID_VIA_8231,     0x00, 0x2f, ATA_UDMA5, },
89         { "vt82c686b",  PCI_DEVICE_ID_VIA_82C686,   0x40, 0x4f, ATA_UDMA5, },
90         { "vt82c686a",  PCI_DEVICE_ID_VIA_82C686,   0x10, 0x2f, ATA_UDMA4, },
91         { "vt82c686",   PCI_DEVICE_ID_VIA_82C686,   0x00, 0x0f, ATA_UDMA2, VIA_BAD_CLK66 },
92         { "vt82c596b",  PCI_DEVICE_ID_VIA_82C596,   0x10, 0x2f, ATA_UDMA4, },
93         { "vt82c596a",  PCI_DEVICE_ID_VIA_82C596,   0x00, 0x0f, ATA_UDMA2, VIA_BAD_CLK66 },
94         { "vt82c586b",  PCI_DEVICE_ID_VIA_82C586_0, 0x47, 0x4f, ATA_UDMA2, VIA_SET_FIFO },
95         { "vt82c586b",  PCI_DEVICE_ID_VIA_82C586_0, 0x40, 0x46, ATA_UDMA2, VIA_SET_FIFO | VIA_BAD_PREQ },
96         { "vt82c586b",  PCI_DEVICE_ID_VIA_82C586_0, 0x30, 0x3f, ATA_UDMA2, VIA_SET_FIFO },
97         { "vt82c586a",  PCI_DEVICE_ID_VIA_82C586_0, 0x20, 0x2f, ATA_UDMA2, VIA_SET_FIFO },
98         { "vt82c586",   PCI_DEVICE_ID_VIA_82C586_0, 0x00, 0x0f,      0x00, VIA_SET_FIFO },
99         { "vt82c576",   PCI_DEVICE_ID_VIA_82C576,   0x00, 0x2f,      0x00, VIA_SET_FIFO | VIA_NO_UNMASK },
100         { "vt82c576",   PCI_DEVICE_ID_VIA_82C576,   0x00, 0x2f,      0x00, VIA_SET_FIFO | VIA_NO_UNMASK | VIA_BAD_ID },
101         { NULL }
102 };
103
104 static unsigned int via_clock;
105 static char *via_dma[] = { "16", "25", "33", "44", "66", "100", "133" };
106
107 struct via82cxxx_dev
108 {
109         struct via_isa_bridge *via_config;
110         unsigned int via_80w;
111 };
112
113 /**
114  *      via_set_speed                   -       write timing registers
115  *      @dev: PCI device
116  *      @dn: device
117  *      @timing: IDE timing data to use
118  *
119  *      via_set_speed writes timing values to the chipset registers
120  */
121
122 static void via_set_speed(ide_hwif_t *hwif, u8 dn, struct ide_timing *timing)
123 {
124         struct pci_dev *dev = hwif->pci_dev;
125         struct via82cxxx_dev *vdev = pci_get_drvdata(hwif->pci_dev);
126         u8 t;
127
128         if (~vdev->via_config->flags & VIA_BAD_AST) {
129                 pci_read_config_byte(dev, VIA_ADDRESS_SETUP, &t);
130                 t = (t & ~(3 << ((3 - dn) << 1))) | ((FIT(timing->setup, 1, 4) - 1) << ((3 - dn) << 1));
131                 pci_write_config_byte(dev, VIA_ADDRESS_SETUP, t);
132         }
133
134         pci_write_config_byte(dev, VIA_8BIT_TIMING + (1 - (dn >> 1)),
135                 ((FIT(timing->act8b, 1, 16) - 1) << 4) | (FIT(timing->rec8b, 1, 16) - 1));
136
137         pci_write_config_byte(dev, VIA_DRIVE_TIMING + (3 - dn),
138                 ((FIT(timing->active, 1, 16) - 1) << 4) | (FIT(timing->recover, 1, 16) - 1));
139
140         switch (vdev->via_config->udma_mask) {
141         case ATA_UDMA2: t = timing->udma ? (0xe0 | (FIT(timing->udma, 2, 5) - 2)) : 0x03; break;
142         case ATA_UDMA4: t = timing->udma ? (0xe8 | (FIT(timing->udma, 2, 9) - 2)) : 0x0f; break;
143         case ATA_UDMA5: t = timing->udma ? (0xe0 | (FIT(timing->udma, 2, 9) - 2)) : 0x07; break;
144         case ATA_UDMA6: t = timing->udma ? (0xe0 | (FIT(timing->udma, 2, 9) - 2)) : 0x07; break;
145         default: return;
146         }
147
148         pci_write_config_byte(dev, VIA_UDMA_TIMING + (3 - dn), t);
149 }
150
151 /**
152  *      via_set_drive           -       configure transfer mode
153  *      @drive: Drive to set up
154  *      @speed: desired speed
155  *
156  *      via_set_drive() computes timing values configures the drive and
157  *      the chipset to a desired transfer mode. It also can be called
158  *      by upper layers.
159  */
160
161 static int via_set_drive(ide_drive_t *drive, u8 speed)
162 {
163         ide_drive_t *peer = HWIF(drive)->drives + (~drive->dn & 1);
164         struct via82cxxx_dev *vdev = pci_get_drvdata(drive->hwif->pci_dev);
165         struct ide_timing t, p;
166         unsigned int T, UT;
167
168         speed = ide_rate_filter(drive, speed);
169
170         if (speed != XFER_PIO_SLOW)
171                 ide_config_drive_speed(drive, speed);
172
173         T = 1000000000 / via_clock;
174
175         switch (vdev->via_config->udma_mask) {
176         case ATA_UDMA2: UT = T;   break;
177         case ATA_UDMA4: UT = T/2; break;
178         case ATA_UDMA5: UT = T/3; break;
179         case ATA_UDMA6: UT = T/4; break;
180         default:        UT = T;
181         }
182
183         ide_timing_compute(drive, speed, &t, T, UT);
184
185         if (peer->present) {
186                 ide_timing_compute(peer, peer->current_speed, &p, T, UT);
187                 ide_timing_merge(&p, &t, &t, IDE_TIMING_8BIT);
188         }
189
190         via_set_speed(HWIF(drive), drive->dn, &t);
191
192         if (!drive->init_speed)
193                 drive->init_speed = speed;
194         drive->current_speed = speed;
195
196         return 0;
197 }
198
199 /**
200  *      via82cxxx_tune_drive    -       PIO setup
201  *      @drive: drive to set up
202  *      @pio: mode to use (255 for 'best possible')
203  *
204  *      A callback from the upper layers for PIO-only tuning.
205  */
206
207 static void via82cxxx_tune_drive(ide_drive_t *drive, u8 pio)
208 {
209         if (pio == 255)
210                 pio = ide_get_best_pio_mode(drive, 255, 5);
211
212         via_set_drive(drive, XFER_PIO_0 + min_t(u8, pio, 5));
213 }
214
215 /**
216  *      via82cxxx_ide_dma_check         -       set up for DMA if possible
217  *      @drive: IDE drive to set up
218  *
219  *      Set up the drive for the highest supported speed considering the
220  *      driver, controller and cable
221  */
222  
223 static int via82cxxx_ide_dma_check (ide_drive_t *drive)
224 {
225         u8 speed = ide_max_dma_mode(drive);
226
227         if (speed == 0) {
228                 via82cxxx_tune_drive(drive, 255);
229                 return -1;
230         }
231
232         via_set_drive(drive, speed);
233
234         if (drive->autodma)
235                 return 0;
236
237         return -1;
238 }
239
240 static struct via_isa_bridge *via_config_find(struct pci_dev **isa)
241 {
242         struct via_isa_bridge *via_config;
243
244         for (via_config = via_isa_bridges; via_config->id; via_config++)
245                 if ((*isa = pci_get_device(PCI_VENDOR_ID_VIA +
246                         !!(via_config->flags & VIA_BAD_ID),
247                         via_config->id, NULL))) {
248
249                         if ((*isa)->revision >= via_config->rev_min &&
250                             (*isa)->revision <= via_config->rev_max)
251                                 break;
252                         pci_dev_put(*isa);
253                 }
254
255         return via_config;
256 }
257
258 /*
259  * Check and handle 80-wire cable presence
260  */
261 static void __devinit via_cable_detect(struct via82cxxx_dev *vdev, u32 u)
262 {
263         int i;
264
265         switch (vdev->via_config->udma_mask) {
266                 case ATA_UDMA4:
267                         for (i = 24; i >= 0; i -= 8)
268                                 if (((u >> (i & 16)) & 8) &&
269                                     ((u >> i) & 0x20) &&
270                                      (((u >> i) & 7) < 2)) {
271                                         /*
272                                          * 2x PCI clock and
273                                          * UDMA w/ < 3T/cycle
274                                          */
275                                         vdev->via_80w |= (1 << (1 - (i >> 4)));
276                                 }
277                         break;
278
279                 case ATA_UDMA5:
280                         for (i = 24; i >= 0; i -= 8)
281                                 if (((u >> i) & 0x10) ||
282                                     (((u >> i) & 0x20) &&
283                                      (((u >> i) & 7) < 4))) {
284                                         /* BIOS 80-wire bit or
285                                          * UDMA w/ < 60ns/cycle
286                                          */
287                                         vdev->via_80w |= (1 << (1 - (i >> 4)));
288                                 }
289                         break;
290
291                 case ATA_UDMA6:
292                         for (i = 24; i >= 0; i -= 8)
293                                 if (((u >> i) & 0x10) ||
294                                     (((u >> i) & 0x20) &&
295                                      (((u >> i) & 7) < 6))) {
296                                         /* BIOS 80-wire bit or
297                                          * UDMA w/ < 60ns/cycle
298                                          */
299                                         vdev->via_80w |= (1 << (1 - (i >> 4)));
300                                 }
301                         break;
302         }
303 }
304
305 /**
306  *      init_chipset_via82cxxx  -       initialization handler
307  *      @dev: PCI device
308  *      @name: Name of interface
309  *
310  *      The initialization callback. Here we determine the IDE chip type
311  *      and initialize its drive independent registers.
312  */
313
314 static unsigned int __devinit init_chipset_via82cxxx(struct pci_dev *dev, const char *name)
315 {
316         struct pci_dev *isa = NULL;
317         struct via82cxxx_dev *vdev;
318         struct via_isa_bridge *via_config;
319         u8 t, v;
320         u32 u;
321
322         vdev = kzalloc(sizeof(*vdev), GFP_KERNEL);
323         if (!vdev) {
324                 printk(KERN_ERR "VP_IDE: out of memory :(\n");
325                 return -ENOMEM;
326         }
327         pci_set_drvdata(dev, vdev);
328
329         /*
330          * Find the ISA bridge to see how good the IDE is.
331          */
332         vdev->via_config = via_config = via_config_find(&isa);
333
334         /* We checked this earlier so if it fails here deeep badness
335            is involved */
336
337         BUG_ON(!via_config->id);
338
339         /*
340          * Detect cable and configure Clk66
341          */
342         pci_read_config_dword(dev, VIA_UDMA_TIMING, &u);
343
344         via_cable_detect(vdev, u);
345
346         if (via_config->udma_mask == ATA_UDMA4) {
347                 /* Enable Clk66 */
348                 pci_write_config_dword(dev, VIA_UDMA_TIMING, u|0x80008);
349         } else if (via_config->flags & VIA_BAD_CLK66) {
350                 /* Would cause trouble on 596a and 686 */
351                 pci_write_config_dword(dev, VIA_UDMA_TIMING, u & ~0x80008);
352         }
353
354         /*
355          * Check whether interfaces are enabled.
356          */
357
358         pci_read_config_byte(dev, VIA_IDE_ENABLE, &v);
359
360         /*
361          * Set up FIFO sizes and thresholds.
362          */
363
364         pci_read_config_byte(dev, VIA_FIFO_CONFIG, &t);
365
366         /* Disable PREQ# till DDACK# */
367         if (via_config->flags & VIA_BAD_PREQ) {
368                 /* Would crash on 586b rev 41 */
369                 t &= 0x7f;
370         }
371
372         /* Fix FIFO split between channels */
373         if (via_config->flags & VIA_SET_FIFO) {
374                 t &= (t & 0x9f);
375                 switch (v & 3) {
376                         case 2: t |= 0x00; break;       /* 16 on primary */
377                         case 1: t |= 0x60; break;       /* 16 on secondary */
378                         case 3: t |= 0x20; break;       /* 8 pri 8 sec */
379                 }
380         }
381
382         pci_write_config_byte(dev, VIA_FIFO_CONFIG, t);
383
384         /*
385          * Determine system bus clock.
386          */
387
388         via_clock = system_bus_clock() * 1000;
389
390         switch (via_clock) {
391                 case 33000: via_clock = 33333; break;
392                 case 37000: via_clock = 37500; break;
393                 case 41000: via_clock = 41666; break;
394         }
395
396         if (via_clock < 20000 || via_clock > 50000) {
397                 printk(KERN_WARNING "VP_IDE: User given PCI clock speed "
398                         "impossible (%d), using 33 MHz instead.\n", via_clock);
399                 printk(KERN_WARNING "VP_IDE: Use ide0=ata66 if you want "
400                         "to assume 80-wire cable.\n");
401                 via_clock = 33333;
402         }
403
404         /*
405          * Print the boot message.
406          */
407
408         printk(KERN_INFO "VP_IDE: VIA %s (rev %02x) IDE %sDMA%s "
409                 "controller on pci%s\n",
410                 via_config->name, isa->revision,
411                 via_config->udma_mask ? "U" : "MW",
412                 via_dma[via_config->udma_mask ?
413                         (fls(via_config->udma_mask) - 1) : 0],
414                 pci_name(dev));
415
416         pci_dev_put(isa);
417         return 0;
418 }
419
420 /*
421  *      Cable special cases
422  */
423
424 static struct dmi_system_id cable_dmi_table[] = {
425         {
426                 .ident = "Acer Ferrari 3400",
427                 .matches = {
428                         DMI_MATCH(DMI_BOARD_VENDOR, "Acer,Inc."),
429                         DMI_MATCH(DMI_BOARD_NAME, "Ferrari 3400"),
430                 },
431         },
432         { }
433 };
434
435 static int via_cable_override(struct pci_dev *pdev)
436 {
437         /* Systems by DMI */
438         if (dmi_check_system(cable_dmi_table))
439                 return 1;
440
441         /* Arima W730-K8/Targa Visionary 811/... */
442         if (pdev->subsystem_vendor == 0x161F &&
443             pdev->subsystem_device == 0x2032)
444                 return 1;
445
446         return 0;
447 }
448
449 static u8 __devinit via82cxxx_cable_detect(ide_hwif_t *hwif)
450 {
451         struct pci_dev *pdev = hwif->pci_dev;
452         struct via82cxxx_dev *vdev = pci_get_drvdata(pdev);
453
454         if (via_cable_override(pdev))
455                 return ATA_CBL_PATA40_SHORT;
456
457         if ((vdev->via_80w >> hwif->channel) & 1)
458                 return ATA_CBL_PATA80;
459         else
460                 return ATA_CBL_PATA40;
461 }
462
463 static void __devinit init_hwif_via82cxxx(ide_hwif_t *hwif)
464 {
465         struct via82cxxx_dev *vdev = pci_get_drvdata(hwif->pci_dev);
466         int i;
467
468         hwif->autodma = 0;
469
470         hwif->tuneproc = &via82cxxx_tune_drive;
471         hwif->speedproc = &via_set_drive;
472
473
474 #ifdef CONFIG_PPC_CHRP
475         if(machine_is(chrp) && _chrp_type == _CHRP_Pegasos) {
476                 hwif->irq = hwif->channel ? 15 : 14;
477         }
478 #endif
479
480         for (i = 0; i < 2; i++) {
481                 hwif->drives[i].io_32bit = 1;
482                 hwif->drives[i].unmask = (vdev->via_config->flags & VIA_NO_UNMASK) ? 0 : 1;
483                 hwif->drives[i].autotune = 1;
484                 hwif->drives[i].dn = hwif->channel * 2 + i;
485         }
486
487         if (!hwif->dma_base)
488                 return;
489
490         hwif->atapi_dma = 1;
491
492         hwif->ultra_mask = vdev->via_config->udma_mask;
493         hwif->mwdma_mask = 0x07;
494         hwif->swdma_mask = 0x07;
495
496         if (hwif->cbl != ATA_CBL_PATA40_SHORT)
497                 hwif->cbl = via82cxxx_cable_detect(hwif);
498
499         hwif->ide_dma_check = &via82cxxx_ide_dma_check;
500         if (!noautodma)
501                 hwif->autodma = 1;
502         hwif->drives[0].autodma = hwif->autodma;
503         hwif->drives[1].autodma = hwif->autodma;
504 }
505
506 static ide_pci_device_t via82cxxx_chipsets[] __devinitdata = {
507         {       /* 0 */
508                 .name           = "VP_IDE",
509                 .init_chipset   = init_chipset_via82cxxx,
510                 .init_hwif      = init_hwif_via82cxxx,
511                 .autodma        = NOAUTODMA,
512                 .enablebits     = {{0x40,0x02,0x02}, {0x40,0x01,0x01}},
513                 .bootable       = ON_BOARD,
514                 .host_flags     = IDE_HFLAG_PIO_NO_BLACKLIST
515                                 | IDE_HFLAG_PIO_NO_DOWNGRADE,
516                 .pio_mask       = ATA_PIO5,
517         },{     /* 1 */
518                 .name           = "VP_IDE",
519                 .init_chipset   = init_chipset_via82cxxx,
520                 .init_hwif      = init_hwif_via82cxxx,
521                 .autodma        = AUTODMA,
522                 .enablebits     = {{0x00,0x00,0x00}, {0x00,0x00,0x00}},
523                 .bootable       = ON_BOARD,
524                 .host_flags     = IDE_HFLAG_PIO_NO_BLACKLIST
525                                 | IDE_HFLAG_PIO_NO_DOWNGRADE,
526                 .pio_mask       = ATA_PIO5,
527         }
528 };
529
530 static int __devinit via_init_one(struct pci_dev *dev, const struct pci_device_id *id)
531 {
532         struct pci_dev *isa = NULL;
533         struct via_isa_bridge *via_config;
534         /*
535          * Find the ISA bridge and check we know what it is.
536          */
537         via_config = via_config_find(&isa);
538         pci_dev_put(isa);
539         if (!via_config->id) {
540                 printk(KERN_WARNING "VP_IDE: Unknown VIA SouthBridge, disabling DMA.\n");
541                 return -ENODEV;
542         }
543         return ide_setup_pci_device(dev, &via82cxxx_chipsets[id->driver_data]);
544 }
545
546 static struct pci_device_id via_pci_tbl[] = {
547         { PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C576_1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
548         { PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C586_1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
549         { PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_6410,     PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
550         { PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_SATA_EIDE,     PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
551         { 0, },
552 };
553 MODULE_DEVICE_TABLE(pci, via_pci_tbl);
554
555 static struct pci_driver driver = {
556         .name           = "VIA_IDE",
557         .id_table       = via_pci_tbl,
558         .probe          = via_init_one,
559 };
560
561 static int __init via_ide_init(void)
562 {
563         return ide_pci_register_driver(&driver);
564 }
565
566 module_init(via_ide_init);
567
568 MODULE_AUTHOR("Vojtech Pavlik, Michel Aubry, Jeff Garzik, Andre Hedrick");
569 MODULE_DESCRIPTION("PCI driver module for VIA IDE");
570 MODULE_LICENSE("GPL");