ide: move ide_config_drive_speed() calls to upper layers (take 2)
[deliverable/linux.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 void triflex_set_mode(ide_drive_t *drive, const u8 speed)
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
52 pci_read_config_dword(dev, channel_offset, &triflex_timings);
53
54 switch(speed) {
55 case XFER_MW_DMA_2:
56 timing = 0x0103;
57 break;
58 case XFER_MW_DMA_1:
59 timing = 0x0203;
60 break;
61 case XFER_MW_DMA_0:
62 timing = 0x0808;
63 break;
64 case XFER_SW_DMA_2:
65 case XFER_SW_DMA_1:
66 case XFER_SW_DMA_0:
67 timing = 0x0f0f;
68 break;
69 case XFER_PIO_4:
70 timing = 0x0202;
71 break;
72 case XFER_PIO_3:
73 timing = 0x0204;
74 break;
75 case XFER_PIO_2:
76 timing = 0x0404;
77 break;
78 case XFER_PIO_1:
79 timing = 0x0508;
80 break;
81 case XFER_PIO_0:
82 timing = 0x0808;
83 break;
84 default:
85 return;
86 }
87
88 triflex_timings &= ~(0xFFFF << (16 * unit));
89 triflex_timings |= (timing << (16 * unit));
90
91 pci_write_config_dword(dev, channel_offset, triflex_timings);
92 }
93
94 static void triflex_set_pio_mode(ide_drive_t *drive, const u8 pio)
95 {
96 triflex_set_mode(drive, XFER_PIO_0 + pio);
97 }
98
99 static int triflex_config_drive_xfer_rate(ide_drive_t *drive)
100 {
101 if (ide_tune_dma(drive))
102 return 0;
103
104 ide_set_max_pio(drive);
105
106 return -1;
107 }
108
109 static void __devinit init_hwif_triflex(ide_hwif_t *hwif)
110 {
111 hwif->set_pio_mode = &triflex_set_pio_mode;
112 hwif->set_dma_mode = &triflex_set_mode;
113
114 if (hwif->dma_base == 0)
115 return;
116
117 hwif->atapi_dma = 1;
118 hwif->mwdma_mask = 0x07;
119 hwif->swdma_mask = 0x07;
120 hwif->ide_dma_check = &triflex_config_drive_xfer_rate;
121
122 if (!noautodma)
123 hwif->autodma = 1;
124 hwif->drives[0].autodma = hwif->autodma;
125 hwif->drives[1].autodma = hwif->autodma;
126 }
127
128 static ide_pci_device_t triflex_device __devinitdata = {
129 .name = "TRIFLEX",
130 .init_hwif = init_hwif_triflex,
131 .autodma = AUTODMA,
132 .enablebits = {{0x80, 0x01, 0x01}, {0x80, 0x02, 0x02}},
133 .bootable = ON_BOARD,
134 .pio_mask = ATA_PIO4,
135 };
136
137 static int __devinit triflex_init_one(struct pci_dev *dev,
138 const struct pci_device_id *id)
139 {
140 return ide_setup_pci_device(dev, &triflex_device);
141 }
142
143 static struct pci_device_id triflex_pci_tbl[] = {
144 { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE,
145 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
146 { 0, },
147 };
148 MODULE_DEVICE_TABLE(pci, triflex_pci_tbl);
149
150 static struct pci_driver driver = {
151 .name = "TRIFLEX_IDE",
152 .id_table = triflex_pci_tbl,
153 .probe = triflex_init_one,
154 };
155
156 static int __init triflex_ide_init(void)
157 {
158 return ide_pci_register_driver(&driver);
159 }
160
161 module_init(triflex_ide_init);
162
163 MODULE_AUTHOR("Torben Mathiasen");
164 MODULE_DESCRIPTION("PCI driver module for Compaq Triflex IDE");
165 MODULE_LICENSE("GPL");
166
167
This page took 0.09812 seconds and 6 git commands to generate.