1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
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
37static void triflex_set_mode(ide_hwif_t *hwif, ide_drive_t *drive)
38{
39 struct pci_dev *dev = to_pci_dev(hwif->dev);
40 u32 triflex_timings = 0;
41 u16 timing = 0;
42 u8 channel_offset = hwif->channel ? 0x74 : 0x70, unit = drive->dn & 1;
43
44 pci_read_config_dword(dev, channel_offset, &triflex_timings);
45
46 switch (drive->dma_mode) {
47 case XFER_MW_DMA_2:
48 timing = 0x0103;
49 break;
50 case XFER_MW_DMA_1:
51 timing = 0x0203;
52 break;
53 case XFER_MW_DMA_0:
54 timing = 0x0808;
55 break;
56 case XFER_SW_DMA_2:
57 case XFER_SW_DMA_1:
58 case XFER_SW_DMA_0:
59 timing = 0x0f0f;
60 break;
61 case XFER_PIO_4:
62 timing = 0x0202;
63 break;
64 case XFER_PIO_3:
65 timing = 0x0204;
66 break;
67 case XFER_PIO_2:
68 timing = 0x0404;
69 break;
70 case XFER_PIO_1:
71 timing = 0x0508;
72 break;
73 case XFER_PIO_0:
74 timing = 0x0808;
75 break;
76 }
77
78 triflex_timings &= ~(0xFFFF << (16 * unit));
79 triflex_timings |= (timing << (16 * unit));
80
81 pci_write_config_dword(dev, channel_offset, triflex_timings);
82}
83
84static void triflex_set_pio_mode(ide_hwif_t *hwif, ide_drive_t *drive)
85{
86 drive->dma_mode = drive->pio_mode;
87 triflex_set_mode(hwif, drive);
88}
89
90static 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
95static const struct ide_port_info triflex_device __devinitconst = {
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
104static 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
110static const struct pci_device_id triflex_pci_tbl[] = {
111 { PCI_VDEVICE(COMPAQ, PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE), 0 },
112 { 0, },
113};
114MODULE_DEVICE_TABLE(pci, triflex_pci_tbl);
115
116#ifdef CONFIG_PM
117static int triflex_ide_pci_suspend(struct pci_dev *dev, pm_message_t state)
118{
119
120
121
122
123 pci_save_state(dev);
124 return 0;
125}
126#else
127#define triflex_ide_pci_suspend NULL
128#endif
129
130static struct pci_driver triflex_pci_driver = {
131 .name = "TRIFLEX_IDE",
132 .id_table = triflex_pci_tbl,
133 .probe = triflex_init_one,
134 .remove = ide_pci_remove,
135 .suspend = triflex_ide_pci_suspend,
136 .resume = ide_pci_resume,
137};
138
139static int __init triflex_ide_init(void)
140{
141 return ide_pci_register_driver(&triflex_pci_driver);
142}
143
144static void __exit triflex_ide_exit(void)
145{
146 pci_unregister_driver(&triflex_pci_driver);
147}
148
149module_init(triflex_ide_init);
150module_exit(triflex_ide_exit);
151
152MODULE_AUTHOR("Torben Mathiasen");
153MODULE_DESCRIPTION("PCI driver module for Compaq Triflex IDE");
154MODULE_LICENSE("GPL");
155
156
157