]> www.pilppa.org Git - linux-2.6-omap-h63xx.git/blob - drivers/ide/pci/aec62xx.c
aec62xx: kill speedproc() method wrapper (take 2)
[linux-2.6-omap-h63xx.git] / drivers / ide / pci / aec62xx.c
1 /*
2  * linux/drivers/ide/pci/aec62xx.c              Version 0.24    May 24, 2007
3  *
4  * Copyright (C) 1999-2002      Andre Hedrick <andre@linux-ide.org>
5  * Copyright (C) 2007           MontaVista Software, Inc. <source@mvista.com>
6  *
7  */
8
9 #include <linux/module.h>
10 #include <linux/types.h>
11 #include <linux/pci.h>
12 #include <linux/delay.h>
13 #include <linux/hdreg.h>
14 #include <linux/ide.h>
15 #include <linux/init.h>
16
17 #include <asm/io.h>
18
19 struct chipset_bus_clock_list_entry {
20         u8 xfer_speed;
21         u8 chipset_settings;
22         u8 ultra_settings;
23 };
24
25 static const struct chipset_bus_clock_list_entry aec6xxx_33_base [] = {
26         {       XFER_UDMA_6,    0x31,   0x07    },
27         {       XFER_UDMA_5,    0x31,   0x06    },
28         {       XFER_UDMA_4,    0x31,   0x05    },
29         {       XFER_UDMA_3,    0x31,   0x04    },
30         {       XFER_UDMA_2,    0x31,   0x03    },
31         {       XFER_UDMA_1,    0x31,   0x02    },
32         {       XFER_UDMA_0,    0x31,   0x01    },
33
34         {       XFER_MW_DMA_2,  0x31,   0x00    },
35         {       XFER_MW_DMA_1,  0x31,   0x00    },
36         {       XFER_MW_DMA_0,  0x0a,   0x00    },
37         {       XFER_PIO_4,     0x31,   0x00    },
38         {       XFER_PIO_3,     0x33,   0x00    },
39         {       XFER_PIO_2,     0x08,   0x00    },
40         {       XFER_PIO_1,     0x0a,   0x00    },
41         {       XFER_PIO_0,     0x00,   0x00    },
42         {       0,              0x00,   0x00    }
43 };
44
45 static const struct chipset_bus_clock_list_entry aec6xxx_34_base [] = {
46         {       XFER_UDMA_6,    0x41,   0x06    },
47         {       XFER_UDMA_5,    0x41,   0x05    },
48         {       XFER_UDMA_4,    0x41,   0x04    },
49         {       XFER_UDMA_3,    0x41,   0x03    },
50         {       XFER_UDMA_2,    0x41,   0x02    },
51         {       XFER_UDMA_1,    0x41,   0x01    },
52         {       XFER_UDMA_0,    0x41,   0x01    },
53
54         {       XFER_MW_DMA_2,  0x41,   0x00    },
55         {       XFER_MW_DMA_1,  0x42,   0x00    },
56         {       XFER_MW_DMA_0,  0x7a,   0x00    },
57         {       XFER_PIO_4,     0x41,   0x00    },
58         {       XFER_PIO_3,     0x43,   0x00    },
59         {       XFER_PIO_2,     0x78,   0x00    },
60         {       XFER_PIO_1,     0x7a,   0x00    },
61         {       XFER_PIO_0,     0x70,   0x00    },
62         {       0,              0x00,   0x00    }
63 };
64
65 #define BUSCLOCK(D)     \
66         ((struct chipset_bus_clock_list_entry *) pci_get_drvdata((D)))
67
68
69 /*
70  * TO DO: active tuning and correction of cards without a bios.
71  */
72 static u8 pci_bus_clock_list (u8 speed, struct chipset_bus_clock_list_entry * chipset_table)
73 {
74         for ( ; chipset_table->xfer_speed ; chipset_table++)
75                 if (chipset_table->xfer_speed == speed) {
76                         return chipset_table->chipset_settings;
77                 }
78         return chipset_table->chipset_settings;
79 }
80
81 static u8 pci_bus_clock_list_ultra (u8 speed, struct chipset_bus_clock_list_entry * chipset_table)
82 {
83         for ( ; chipset_table->xfer_speed ; chipset_table++)
84                 if (chipset_table->xfer_speed == speed) {
85                         return chipset_table->ultra_settings;
86                 }
87         return chipset_table->ultra_settings;
88 }
89
90 static int aec6210_tune_chipset (ide_drive_t *drive, u8 xferspeed)
91 {
92         ide_hwif_t *hwif        = HWIF(drive);
93         struct pci_dev *dev     = hwif->pci_dev;
94         u16 d_conf              = 0;
95         u8 speed                = ide_rate_filter(drive, xferspeed);
96         u8 ultra = 0, ultra_conf = 0;
97         u8 tmp0 = 0, tmp1 = 0, tmp2 = 0;
98         unsigned long flags;
99
100         local_irq_save(flags);
101         /* 0x40|(2*drive->dn): Active, 0x41|(2*drive->dn): Recovery */
102         pci_read_config_word(dev, 0x40|(2*drive->dn), &d_conf);
103         tmp0 = pci_bus_clock_list(speed, BUSCLOCK(dev));
104         d_conf = ((tmp0 & 0xf0) << 4) | (tmp0 & 0xf);
105         pci_write_config_word(dev, 0x40|(2*drive->dn), d_conf);
106
107         tmp1 = 0x00;
108         tmp2 = 0x00;
109         pci_read_config_byte(dev, 0x54, &ultra);
110         tmp1 = ((0x00 << (2*drive->dn)) | (ultra & ~(3 << (2*drive->dn))));
111         ultra_conf = pci_bus_clock_list_ultra(speed, BUSCLOCK(dev));
112         tmp2 = ((ultra_conf << (2*drive->dn)) | (tmp1 & ~(3 << (2*drive->dn))));
113         pci_write_config_byte(dev, 0x54, tmp2);
114         local_irq_restore(flags);
115         return(ide_config_drive_speed(drive, speed));
116 }
117
118 static int aec6260_tune_chipset (ide_drive_t *drive, u8 xferspeed)
119 {
120         ide_hwif_t *hwif        = HWIF(drive);
121         struct pci_dev *dev     = hwif->pci_dev;
122         u8 speed        = ide_rate_filter(drive, xferspeed);
123         u8 unit         = (drive->select.b.unit & 0x01);
124         u8 tmp1 = 0, tmp2 = 0;
125         u8 ultra = 0, drive_conf = 0, ultra_conf = 0;
126         unsigned long flags;
127
128         local_irq_save(flags);
129         /* high 4-bits: Active, low 4-bits: Recovery */
130         pci_read_config_byte(dev, 0x40|drive->dn, &drive_conf);
131         drive_conf = pci_bus_clock_list(speed, BUSCLOCK(dev));
132         pci_write_config_byte(dev, 0x40|drive->dn, drive_conf);
133
134         pci_read_config_byte(dev, (0x44|hwif->channel), &ultra);
135         tmp1 = ((0x00 << (4*unit)) | (ultra & ~(7 << (4*unit))));
136         ultra_conf = pci_bus_clock_list_ultra(speed, BUSCLOCK(dev));
137         tmp2 = ((ultra_conf << (4*unit)) | (tmp1 & ~(7 << (4*unit))));
138         pci_write_config_byte(dev, (0x44|hwif->channel), tmp2);
139         local_irq_restore(flags);
140         return(ide_config_drive_speed(drive, speed));
141 }
142
143 static void aec62xx_tune_drive (ide_drive_t *drive, u8 pio)
144 {
145         pio = ide_get_best_pio_mode(drive, pio, 4, NULL);
146         (void) HWIF(drive)->speedproc(drive, pio + XFER_PIO_0);
147 }
148
149 static int aec62xx_config_drive_xfer_rate (ide_drive_t *drive)
150 {
151         if (ide_tune_dma(drive))
152                 return 0;
153
154         if (ide_use_fast_pio(drive))
155                 aec62xx_tune_drive(drive, 255);
156
157         return -1;
158 }
159
160 static void aec62xx_dma_lost_irq (ide_drive_t *drive)
161 {
162         switch (HWIF(drive)->pci_dev->device) {
163                 case PCI_DEVICE_ID_ARTOP_ATP860:
164                 case PCI_DEVICE_ID_ARTOP_ATP860R:
165                 case PCI_DEVICE_ID_ARTOP_ATP865:
166                 case PCI_DEVICE_ID_ARTOP_ATP865R:
167                         printk(" AEC62XX time out ");
168                 default:
169                         break;
170         }
171 }
172
173 static unsigned int __devinit init_chipset_aec62xx(struct pci_dev *dev, const char *name)
174 {
175         int bus_speed = system_bus_clock();
176
177         if (dev->resource[PCI_ROM_RESOURCE].start) {
178                 pci_write_config_dword(dev, PCI_ROM_ADDRESS, dev->resource[PCI_ROM_RESOURCE].start | PCI_ROM_ADDRESS_ENABLE);
179                 printk(KERN_INFO "%s: ROM enabled at 0x%08lx\n", name,
180                         (unsigned long)dev->resource[PCI_ROM_RESOURCE].start);
181         }
182
183         if (bus_speed <= 33)
184                 pci_set_drvdata(dev, (void *) aec6xxx_33_base);
185         else
186                 pci_set_drvdata(dev, (void *) aec6xxx_34_base);
187
188         /* These are necessary to get AEC6280 Macintosh cards to work */
189         if ((dev->device == PCI_DEVICE_ID_ARTOP_ATP865) ||
190             (dev->device == PCI_DEVICE_ID_ARTOP_ATP865R)) {
191                 u8 reg49h = 0, reg4ah = 0;
192                 /* Clear reset and test bits.  */
193                 pci_read_config_byte(dev, 0x49, &reg49h);
194                 pci_write_config_byte(dev, 0x49, reg49h & ~0x30);
195                 /* Enable chip interrupt output.  */
196                 pci_read_config_byte(dev, 0x4a, &reg4ah);
197                 pci_write_config_byte(dev, 0x4a, reg4ah & ~0x01);
198                 /* Enable burst mode. */
199                 pci_read_config_byte(dev, 0x4a, &reg4ah);
200                 pci_write_config_byte(dev, 0x4a, reg4ah | 0x80);
201         }
202
203         return dev->irq;
204 }
205
206 static void __devinit init_hwif_aec62xx(ide_hwif_t *hwif)
207 {
208         struct pci_dev *dev     = hwif->pci_dev;
209         u8 reg54 = 0,  mask     = hwif->channel ? 0xf0 : 0x0f;
210         unsigned long flags;
211
212         hwif->tuneproc = &aec62xx_tune_drive;
213
214         if (dev->device == PCI_DEVICE_ID_ARTOP_ATP850UF) {
215                 if(hwif->mate)
216                         hwif->mate->serialized = hwif->serialized = 1;
217                 hwif->speedproc = &aec6210_tune_chipset;
218         } else
219                 hwif->speedproc = &aec6260_tune_chipset;
220
221         if (!hwif->dma_base) {
222                 hwif->drives[0].autotune = hwif->drives[1].autotune = 1;
223                 return;
224         }
225
226         hwif->ultra_mask = hwif->cds->udma_mask;
227         hwif->mwdma_mask = 0x07;
228
229         hwif->ide_dma_check     = &aec62xx_config_drive_xfer_rate;
230         hwif->dma_lost_irq      = &aec62xx_dma_lost_irq;
231
232         if (dev->device == PCI_DEVICE_ID_ARTOP_ATP850UF) {
233                 spin_lock_irqsave(&ide_lock, flags);
234                 pci_read_config_byte (dev, 0x54, &reg54);
235                 pci_write_config_byte(dev, 0x54, (reg54 & ~mask));
236                 spin_unlock_irqrestore(&ide_lock, flags);
237         } else if (!hwif->udma_four) {
238                 u8 ata66 = 0, mask = hwif->channel ? 0x02 : 0x01;
239
240                 pci_read_config_byte(hwif->pci_dev, 0x49, &ata66);
241                 hwif->udma_four = (ata66 & mask) ? 0 : 1;
242         }
243
244         if (!noautodma)
245                 hwif->autodma = 1;
246         hwif->drives[0].autodma = hwif->drives[1].autodma = hwif->autodma;
247 }
248
249 static int __devinit init_setup_aec62xx(struct pci_dev *dev, ide_pci_device_t *d)
250 {
251         return ide_setup_pci_device(dev, d);
252 }
253
254 static int __devinit init_setup_aec6x80(struct pci_dev *dev, ide_pci_device_t *d)
255 {
256         unsigned long dma_base = pci_resource_start(dev, 4);
257
258         if (inb(dma_base + 2) & 0x10) {
259                 d->name = (dev->device == PCI_DEVICE_ID_ARTOP_ATP865R) ?
260                           "AEC6880R" : "AEC6880";
261                 d->udma_mask = 0x7f; /* udma0-6 */
262         }
263
264         return ide_setup_pci_device(dev, d);
265 }
266
267 static ide_pci_device_t aec62xx_chipsets[] __devinitdata = {
268         {       /* 0 */
269                 .name           = "AEC6210",
270                 .init_setup     = init_setup_aec62xx,
271                 .init_chipset   = init_chipset_aec62xx,
272                 .init_hwif      = init_hwif_aec62xx,
273                 .channels       = 2,
274                 .autodma        = AUTODMA,
275                 .enablebits     = {{0x4a,0x02,0x02}, {0x4a,0x04,0x04}},
276                 .bootable       = OFF_BOARD,
277                 .udma_mask      = 0x07, /* udma0-2 */
278         },{     /* 1 */
279                 .name           = "AEC6260",
280                 .init_setup     = init_setup_aec62xx,
281                 .init_chipset   = init_chipset_aec62xx,
282                 .init_hwif      = init_hwif_aec62xx,
283                 .channels       = 2,
284                 .autodma        = NOAUTODMA,
285                 .bootable       = OFF_BOARD,
286                 .udma_mask      = 0x1f, /* udma0-4 */
287         },{     /* 2 */
288                 .name           = "AEC6260R",
289                 .init_setup     = init_setup_aec62xx,
290                 .init_chipset   = init_chipset_aec62xx,
291                 .init_hwif      = init_hwif_aec62xx,
292                 .channels       = 2,
293                 .autodma        = AUTODMA,
294                 .enablebits     = {{0x4a,0x02,0x02}, {0x4a,0x04,0x04}},
295                 .bootable       = NEVER_BOARD,
296                 .udma_mask      = 0x1f, /* udma0-4 */
297         },{     /* 3 */
298                 .name           = "AEC6280",
299                 .init_setup     = init_setup_aec6x80,
300                 .init_chipset   = init_chipset_aec62xx,
301                 .init_hwif      = init_hwif_aec62xx,
302                 .channels       = 2,
303                 .autodma        = AUTODMA,
304                 .bootable       = OFF_BOARD,
305                 .udma_mask      = 0x3f, /* udma0-5 */
306         },{     /* 4 */
307                 .name           = "AEC6280R",
308                 .init_setup     = init_setup_aec6x80,
309                 .init_chipset   = init_chipset_aec62xx,
310                 .init_hwif      = init_hwif_aec62xx,
311                 .channels       = 2,
312                 .autodma        = AUTODMA,
313                 .enablebits     = {{0x4a,0x02,0x02}, {0x4a,0x04,0x04}},
314                 .bootable       = OFF_BOARD,
315                 .udma_mask      = 0x3f, /* udma0-5 */
316         }
317 };
318
319 /**
320  *      aec62xx_init_one        -       called when a AEC is found
321  *      @dev: the aec62xx device
322  *      @id: the matching pci id
323  *
324  *      Called when the PCI registration layer (or the IDE initialization)
325  *      finds a device matching our IDE device tables.
326  *
327  *      NOTE: since we're going to modify the 'name' field for AEC-6[26]80[R]
328  *      chips, pass a local copy of 'struct pci_device_id' down the call chain.
329  */
330  
331 static int __devinit aec62xx_init_one(struct pci_dev *dev, const struct pci_device_id *id)
332 {
333         ide_pci_device_t d = aec62xx_chipsets[id->driver_data];
334
335         return d.init_setup(dev, &d);
336 }
337
338 static struct pci_device_id aec62xx_pci_tbl[] = {
339         { PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_ATP850UF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
340         { PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_ATP860,   PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
341         { PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_ATP860R,  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2 },
342         { PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_ATP865,   PCI_ANY_ID, PCI_ANY_ID, 0, 0, 3 },
343         { PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_ATP865R,  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 4 },
344         { 0, },
345 };
346 MODULE_DEVICE_TABLE(pci, aec62xx_pci_tbl);
347
348 static struct pci_driver driver = {
349         .name           = "AEC62xx_IDE",
350         .id_table       = aec62xx_pci_tbl,
351         .probe          = aec62xx_init_one,
352 };
353
354 static int __init aec62xx_ide_init(void)
355 {
356         return ide_pci_register_driver(&driver);
357 }
358
359 module_init(aec62xx_ide_init);
360
361 MODULE_AUTHOR("Andre Hedrick");
362 MODULE_DESCRIPTION("PCI driver module for ARTOP AEC62xx IDE");
363 MODULE_LICENSE("GPL");