ide: add missing __init tags to IDE PCI host drivers
[sfrench/cifs-2.6.git] / drivers / ide / pci / triflex.c
1 /*
2  * triflex.c
3  * 
4  * IDE Chipset driver for the Compaq TriFlex IDE controller.
5  * 
6  * Known to work with the Compaq Workstation 5x00 series.
7  *
8  * Copyright (C) 2002 Hewlett-Packard Development Group, L.P.
9  * Author: Torben Mathiasen <torben.mathiasen@hp.com>
10  *
11  * This program is free software; you can redistribute it and/or modify
12  * it under the terms of the GNU General Public License version 2 as
13  * published by the Free Software Foundation.
14  *
15  * This program is distributed in the hope that it will be useful,
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  * GNU General Public License for more details.
19  *
20  * You should have received a copy of the GNU General Public License
21  * along with this program; if not, write to the Free Software
22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
23  * 
24  * Loosely based on the piix & svwks drivers.
25  *
26  * Documentation:
27  *      Not publically available.
28  */
29
30 #include <linux/types.h>
31 #include <linux/module.h>
32 #include <linux/kernel.h>
33 #include <linux/delay.h>
34 #include <linux/timer.h>
35 #include <linux/mm.h>
36 #include <linux/ioport.h>
37 #include <linux/blkdev.h>
38 #include <linux/hdreg.h>
39 #include <linux/pci.h>
40 #include <linux/ide.h>
41 #include <linux/init.h>
42
43 static int triflex_tune_chipset(ide_drive_t *drive, u8 xferspeed)
44 {
45         ide_hwif_t *hwif = HWIF(drive);
46         struct pci_dev *dev = hwif->pci_dev;
47         u8 channel_offset = hwif->channel ? 0x74 : 0x70;
48         u16 timing = 0;
49         u32 triflex_timings = 0;
50         u8 unit = (drive->select.b.unit & 0x01);
51         u8 speed = ide_rate_filter(0, xferspeed);
52         
53         pci_read_config_dword(dev, channel_offset, &triflex_timings);
54         
55         switch(speed) {
56                 case XFER_MW_DMA_2:
57                         timing = 0x0103; 
58                         break;
59                 case XFER_MW_DMA_1:
60                         timing = 0x0203;
61                         break;
62                 case XFER_MW_DMA_0:
63                         timing = 0x0808;
64                         break;
65                 case XFER_SW_DMA_2:
66                 case XFER_SW_DMA_1:
67                 case XFER_SW_DMA_0:
68                         timing = 0x0f0f;
69                         break;
70                 case XFER_PIO_4:
71                         timing = 0x0202;
72                         break;
73                 case XFER_PIO_3:
74                         timing = 0x0204;
75                         break;
76                 case XFER_PIO_2:
77                         timing = 0x0404;
78                         break;
79                 case XFER_PIO_1:
80                         timing = 0x0508;
81                         break;
82                 case XFER_PIO_0:
83                         timing = 0x0808;
84                         break;
85                 default:
86                         return -1;
87         }
88
89         triflex_timings &= ~(0xFFFF << (16 * unit));
90         triflex_timings |= (timing << (16 * unit));
91         
92         pci_write_config_dword(dev, channel_offset, triflex_timings);
93         
94         return (ide_config_drive_speed(drive, speed));
95 }
96
97 static void triflex_tune_drive(ide_drive_t *drive, u8 pio)
98 {
99         int use_pio = ide_get_best_pio_mode(drive, pio, 4, NULL);
100         (void) triflex_tune_chipset(drive, (XFER_PIO_0 + use_pio));
101 }
102
103 static int triflex_config_drive_for_dma(ide_drive_t *drive)
104 {
105         int speed = ide_dma_speed(drive, 0); /* No ultra speeds */
106
107         if (!speed) { 
108                 u8 pspeed = ide_get_best_pio_mode(drive, 255, 4, NULL);
109                 speed = XFER_PIO_0 + pspeed;
110         }
111         
112         (void) triflex_tune_chipset(drive, speed);
113          return ide_dma_enable(drive);
114 }
115
116 static int triflex_config_drive_xfer_rate(ide_drive_t *drive)
117 {
118         ide_hwif_t *hwif        = HWIF(drive);
119         struct hd_driveid *id   = drive->id;
120
121         if ((id->capability & 1) && drive->autodma) {
122                 if (ide_use_dma(drive)) {
123                         if (triflex_config_drive_for_dma(drive))
124                                 return hwif->ide_dma_on(drive);
125                 }
126         }
127
128         hwif->tuneproc(drive, 255);
129         return hwif->ide_dma_off_quietly(drive);
130 }
131
132 static void __devinit init_hwif_triflex(ide_hwif_t *hwif)
133 {
134         hwif->tuneproc = &triflex_tune_drive;
135         hwif->speedproc = &triflex_tune_chipset;
136
137         hwif->atapi_dma  = 1;
138         hwif->mwdma_mask = 0x07;
139         hwif->swdma_mask = 0x07;
140         hwif->ide_dma_check = &triflex_config_drive_xfer_rate;
141         
142         if (!noautodma)
143                 hwif->autodma = 1;
144         hwif->drives[0].autodma = hwif->autodma;
145         hwif->drives[1].autodma = hwif->autodma;
146 }
147
148 static ide_pci_device_t triflex_device __devinitdata = {
149         .name           = "TRIFLEX",
150         .init_hwif      = init_hwif_triflex,
151         .channels       = 2,
152         .autodma        = AUTODMA,
153         .enablebits     = {{0x80, 0x01, 0x01}, {0x80, 0x02, 0x02}},
154         .bootable       = ON_BOARD,
155 };
156
157 static int __devinit triflex_init_one(struct pci_dev *dev, 
158                 const struct pci_device_id *id)
159 {
160         return ide_setup_pci_device(dev, &triflex_device);
161 }
162
163 static struct pci_device_id triflex_pci_tbl[] = {
164         { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE,
165           PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
166         { 0, },
167 };
168 MODULE_DEVICE_TABLE(pci, triflex_pci_tbl);
169
170 static struct pci_driver driver = {
171         .name           = "TRIFLEX_IDE",
172         .id_table       = triflex_pci_tbl,
173         .probe          = triflex_init_one,
174 };
175
176 static int __init triflex_ide_init(void)
177 {
178         return ide_pci_register_driver(&driver);
179 }
180
181 module_init(triflex_ide_init);
182
183 MODULE_AUTHOR("Torben Mathiasen");
184 MODULE_DESCRIPTION("PCI driver module for Compaq Triflex IDE");
185 MODULE_LICENSE("GPL");
186
187