diff options
Diffstat (limited to 'drivers/ide/pci/triflex.c')
-rw-r--r-- | drivers/ide/pci/triflex.c | 188 |
1 files changed, 188 insertions, 0 deletions
diff --git a/drivers/ide/pci/triflex.c b/drivers/ide/pci/triflex.c new file mode 100644 index 000000000000..a1df2bfe3631 --- /dev/null +++ b/drivers/ide/pci/triflex.c | |||
@@ -0,0 +1,188 @@ | |||
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/config.h> | ||
31 | #include <linux/types.h> | ||
32 | #include <linux/module.h> | ||
33 | #include <linux/kernel.h> | ||
34 | #include <linux/delay.h> | ||
35 | #include <linux/timer.h> | ||
36 | #include <linux/mm.h> | ||
37 | #include <linux/ioport.h> | ||
38 | #include <linux/blkdev.h> | ||
39 | #include <linux/hdreg.h> | ||
40 | #include <linux/pci.h> | ||
41 | #include <linux/ide.h> | ||
42 | #include <linux/init.h> | ||
43 | |||
44 | static int triflex_tune_chipset(ide_drive_t *drive, u8 xferspeed) | ||
45 | { | ||
46 | ide_hwif_t *hwif = HWIF(drive); | ||
47 | struct pci_dev *dev = hwif->pci_dev; | ||
48 | u8 channel_offset = hwif->channel ? 0x74 : 0x70; | ||
49 | u16 timing = 0; | ||
50 | u32 triflex_timings = 0; | ||
51 | u8 unit = (drive->select.b.unit & 0x01); | ||
52 | u8 speed = ide_rate_filter(0, xferspeed); | ||
53 | |||
54 | pci_read_config_dword(dev, channel_offset, &triflex_timings); | ||
55 | |||
56 | switch(speed) { | ||
57 | case XFER_MW_DMA_2: | ||
58 | timing = 0x0103; | ||
59 | break; | ||
60 | case XFER_MW_DMA_1: | ||
61 | timing = 0x0203; | ||
62 | break; | ||
63 | case XFER_MW_DMA_0: | ||
64 | timing = 0x0808; | ||
65 | break; | ||
66 | case XFER_SW_DMA_2: | ||
67 | case XFER_SW_DMA_1: | ||
68 | case XFER_SW_DMA_0: | ||
69 | timing = 0x0f0f; | ||
70 | break; | ||
71 | case XFER_PIO_4: | ||
72 | timing = 0x0202; | ||
73 | break; | ||
74 | case XFER_PIO_3: | ||
75 | timing = 0x0204; | ||
76 | break; | ||
77 | case XFER_PIO_2: | ||
78 | timing = 0x0404; | ||
79 | break; | ||
80 | case XFER_PIO_1: | ||
81 | timing = 0x0508; | ||
82 | break; | ||
83 | case XFER_PIO_0: | ||
84 | timing = 0x0808; | ||
85 | break; | ||
86 | default: | ||
87 | return -1; | ||
88 | } | ||
89 | |||
90 | triflex_timings &= ~(0xFFFF << (16 * unit)); | ||
91 | triflex_timings |= (timing << (16 * unit)); | ||
92 | |||
93 | pci_write_config_dword(dev, channel_offset, triflex_timings); | ||
94 | |||
95 | return (ide_config_drive_speed(drive, speed)); | ||
96 | } | ||
97 | |||
98 | static void triflex_tune_drive(ide_drive_t *drive, u8 pio) | ||
99 | { | ||
100 | int use_pio = ide_get_best_pio_mode(drive, pio, 4, NULL); | ||
101 | (void) triflex_tune_chipset(drive, (XFER_PIO_0 + use_pio)); | ||
102 | } | ||
103 | |||
104 | static int triflex_config_drive_for_dma(ide_drive_t *drive) | ||
105 | { | ||
106 | int speed = ide_dma_speed(drive, 0); /* No ultra speeds */ | ||
107 | |||
108 | if (!speed) { | ||
109 | u8 pspeed = ide_get_best_pio_mode(drive, 255, 4, NULL); | ||
110 | speed = XFER_PIO_0 + pspeed; | ||
111 | } | ||
112 | |||
113 | (void) triflex_tune_chipset(drive, speed); | ||
114 | return ide_dma_enable(drive); | ||
115 | } | ||
116 | |||
117 | static int triflex_config_drive_xfer_rate(ide_drive_t *drive) | ||
118 | { | ||
119 | ide_hwif_t *hwif = HWIF(drive); | ||
120 | struct hd_driveid *id = drive->id; | ||
121 | |||
122 | if ((id->capability & 1) && drive->autodma) { | ||
123 | if (ide_use_dma(drive)) { | ||
124 | if (triflex_config_drive_for_dma(drive)) | ||
125 | return hwif->ide_dma_on(drive); | ||
126 | } | ||
127 | } | ||
128 | |||
129 | hwif->tuneproc(drive, 255); | ||
130 | return hwif->ide_dma_off_quietly(drive); | ||
131 | } | ||
132 | |||
133 | static void __init init_hwif_triflex(ide_hwif_t *hwif) | ||
134 | { | ||
135 | hwif->tuneproc = &triflex_tune_drive; | ||
136 | hwif->speedproc = &triflex_tune_chipset; | ||
137 | |||
138 | hwif->atapi_dma = 1; | ||
139 | hwif->mwdma_mask = 0x07; | ||
140 | hwif->swdma_mask = 0x07; | ||
141 | hwif->ide_dma_check = &triflex_config_drive_xfer_rate; | ||
142 | |||
143 | if (!noautodma) | ||
144 | hwif->autodma = 1; | ||
145 | hwif->drives[0].autodma = hwif->autodma; | ||
146 | hwif->drives[1].autodma = hwif->autodma; | ||
147 | } | ||
148 | |||
149 | static ide_pci_device_t triflex_device __devinitdata = { | ||
150 | .name = "TRIFLEX", | ||
151 | .init_hwif = init_hwif_triflex, | ||
152 | .channels = 2, | ||
153 | .autodma = AUTODMA, | ||
154 | .enablebits = {{0x80, 0x01, 0x01}, {0x80, 0x02, 0x02}}, | ||
155 | .bootable = ON_BOARD, | ||
156 | }; | ||
157 | |||
158 | static int __devinit triflex_init_one(struct pci_dev *dev, | ||
159 | const struct pci_device_id *id) | ||
160 | { | ||
161 | return ide_setup_pci_device(dev, &triflex_device); | ||
162 | } | ||
163 | |||
164 | static struct pci_device_id triflex_pci_tbl[] = { | ||
165 | { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE, | ||
166 | PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 }, | ||
167 | { 0, }, | ||
168 | }; | ||
169 | MODULE_DEVICE_TABLE(pci, triflex_pci_tbl); | ||
170 | |||
171 | static struct pci_driver driver = { | ||
172 | .name = "TRIFLEX_IDE", | ||
173 | .id_table = triflex_pci_tbl, | ||
174 | .probe = triflex_init_one, | ||
175 | }; | ||
176 | |||
177 | static int triflex_ide_init(void) | ||
178 | { | ||
179 | return ide_pci_register_driver(&driver); | ||
180 | } | ||
181 | |||
182 | module_init(triflex_ide_init); | ||
183 | |||
184 | MODULE_AUTHOR("Torben Mathiasen"); | ||
185 | MODULE_DESCRIPTION("PCI driver module for Compaq Triflex IDE"); | ||
186 | MODULE_LICENSE("GPL"); | ||
187 | |||
188 | |||