md: tidy up status_resync to handle large arrays.
[linux-2.6] / drivers / ide / triflex.c
1 /*
2  * IDE Chipset driver for the Compaq TriFlex IDE controller.
3  * 
4  * Known to work with the Compaq Workstation 5x00 series.
5  *
6  * Copyright (C) 2002 Hewlett-Packard Development Group, L.P.
7  * Author: Torben Mathiasen <torben.mathiasen@hp.com>
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
21  * 
22  * Loosely based on the piix & svwks drivers.
23  *
24  * Documentation:
25  *      Not publically available.
26  */
27
28 #include <linux/types.h>
29 #include <linux/module.h>
30 #include <linux/kernel.h>
31 #include <linux/pci.h>
32 #include <linux/ide.h>
33 #include <linux/init.h>
34
35 #define DRV_NAME "triflex"
36
37 static void triflex_set_mode(ide_drive_t *drive, const u8 speed)
38 {
39         ide_hwif_t *hwif = drive->hwif;
40         struct pci_dev *dev = to_pci_dev(hwif->dev);
41         u32 triflex_timings = 0;
42         u16 timing = 0;
43         u8 channel_offset = hwif->channel ? 0x74 : 0x70, unit = drive->dn & 1;
44
45         pci_read_config_dword(dev, channel_offset, &triflex_timings);
46
47         switch(speed) {
48                 case XFER_MW_DMA_2:
49                         timing = 0x0103; 
50                         break;
51                 case XFER_MW_DMA_1:
52                         timing = 0x0203;
53                         break;
54                 case XFER_MW_DMA_0:
55                         timing = 0x0808;
56                         break;
57                 case XFER_SW_DMA_2:
58                 case XFER_SW_DMA_1:
59                 case XFER_SW_DMA_0:
60                         timing = 0x0f0f;
61                         break;
62                 case XFER_PIO_4:
63                         timing = 0x0202;
64                         break;
65                 case XFER_PIO_3:
66                         timing = 0x0204;
67                         break;
68                 case XFER_PIO_2:
69                         timing = 0x0404;
70                         break;
71                 case XFER_PIO_1:
72                         timing = 0x0508;
73                         break;
74                 case XFER_PIO_0:
75                         timing = 0x0808;
76                         break;
77         }
78
79         triflex_timings &= ~(0xFFFF << (16 * unit));
80         triflex_timings |= (timing << (16 * unit));
81         
82         pci_write_config_dword(dev, channel_offset, triflex_timings);
83 }
84
85 static void triflex_set_pio_mode(ide_drive_t *drive, const u8 pio)
86 {
87         triflex_set_mode(drive, XFER_PIO_0 + pio);
88 }
89
90 static const struct ide_port_ops triflex_port_ops = {
91         .set_pio_mode           = triflex_set_pio_mode,
92         .set_dma_mode           = triflex_set_mode,
93 };
94
95 static const struct ide_port_info triflex_device __devinitdata = {
96         .name           = DRV_NAME,
97         .enablebits     = {{0x80, 0x01, 0x01}, {0x80, 0x02, 0x02}},
98         .port_ops       = &triflex_port_ops,
99         .pio_mask       = ATA_PIO4,
100         .swdma_mask     = ATA_SWDMA2,
101         .mwdma_mask     = ATA_MWDMA2,
102 };
103
104 static int __devinit triflex_init_one(struct pci_dev *dev, 
105                 const struct pci_device_id *id)
106 {
107         return ide_pci_init_one(dev, &triflex_device, NULL);
108 }
109
110 static const struct pci_device_id triflex_pci_tbl[] = {
111         { PCI_VDEVICE(COMPAQ, PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE), 0 },
112         { 0, },
113 };
114 MODULE_DEVICE_TABLE(pci, triflex_pci_tbl);
115
116 static struct pci_driver triflex_pci_driver = {
117         .name           = "TRIFLEX_IDE",
118         .id_table       = triflex_pci_tbl,
119         .probe          = triflex_init_one,
120         .remove         = ide_pci_remove,
121         .suspend        = ide_pci_suspend,
122         .resume         = ide_pci_resume,
123 };
124
125 static int __init triflex_ide_init(void)
126 {
127         return ide_pci_register_driver(&triflex_pci_driver);
128 }
129
130 static void __exit triflex_ide_exit(void)
131 {
132         pci_unregister_driver(&triflex_pci_driver);
133 }
134
135 module_init(triflex_ide_init);
136 module_exit(triflex_ide_exit);
137
138 MODULE_AUTHOR("Torben Mathiasen");
139 MODULE_DESCRIPTION("PCI driver module for Compaq Triflex IDE");
140 MODULE_LICENSE("GPL");
141
142