RT-AC66 3.0.0.4.374.130 core
[tomato.git] / release / src-rt-6.x / linux / linux-2.6 / drivers / ide / pci / triflex.c
blob35e8c612638f687509c42311c38d13973f92752c
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.
8 * Copyright (C) 2002 Hewlett-Packard Development Group, L.P.
9 * Author: Torben Mathiasen <torben.mathiasen@hp.com>
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.
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.
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
24 * Loosely based on the piix & svwks drivers.
26 * Documentation:
27 * Not publically available.
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>
43 static int triflex_tune_chipset(ide_drive_t *drive, u8 xferspeed)
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(drive, xferspeed);
53 pci_read_config_dword(dev, channel_offset, &triflex_timings);
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;
89 triflex_timings &= ~(0xFFFF << (16 * unit));
90 triflex_timings |= (timing << (16 * unit));
92 pci_write_config_dword(dev, channel_offset, triflex_timings);
94 return (ide_config_drive_speed(drive, speed));
97 static void triflex_tune_drive(ide_drive_t *drive, u8 pio)
99 int use_pio = ide_get_best_pio_mode(drive, pio, 4, NULL);
100 (void) triflex_tune_chipset(drive, (XFER_PIO_0 + use_pio));
103 static int triflex_config_drive_xfer_rate(ide_drive_t *drive)
105 if (ide_tune_dma(drive))
106 return 0;
108 triflex_tune_drive(drive, 255);
110 return -1;
113 static void __devinit init_hwif_triflex(ide_hwif_t *hwif)
115 hwif->tuneproc = &triflex_tune_drive;
116 hwif->speedproc = &triflex_tune_chipset;
118 hwif->atapi_dma = 1;
119 hwif->mwdma_mask = 0x07;
120 hwif->swdma_mask = 0x07;
121 hwif->ide_dma_check = &triflex_config_drive_xfer_rate;
123 if (!noautodma)
124 hwif->autodma = 1;
125 hwif->drives[0].autodma = hwif->autodma;
126 hwif->drives[1].autodma = hwif->autodma;
129 static ide_pci_device_t triflex_device __devinitdata = {
130 .name = "TRIFLEX",
131 .init_hwif = init_hwif_triflex,
132 .channels = 2,
133 .autodma = AUTODMA,
134 .enablebits = {{0x80, 0x01, 0x01}, {0x80, 0x02, 0x02}},
135 .bootable = ON_BOARD,
138 static int __devinit triflex_init_one(struct pci_dev *dev,
139 const struct pci_device_id *id)
141 return ide_setup_pci_device(dev, &triflex_device);
144 static struct pci_device_id triflex_pci_tbl[] = {
145 { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE,
146 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
147 { 0, },
149 MODULE_DEVICE_TABLE(pci, triflex_pci_tbl);
151 static struct pci_driver driver = {
152 .name = "TRIFLEX_IDE",
153 .id_table = triflex_pci_tbl,
154 .probe = triflex_init_one,
157 static int __init triflex_ide_init(void)
159 return ide_pci_register_driver(&driver);
162 module_init(triflex_ide_init);
164 MODULE_AUTHOR("Torben Mathiasen");
165 MODULE_DESCRIPTION("PCI driver module for Compaq Triflex IDE");
166 MODULE_LICENSE("GPL");