1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/kernel.h>
16#include <linux/module.h>
17#include <linux/pci.h>
18#include <linux/init.h>
19#include <linux/blkdev.h>
20#include <linux/delay.h>
21#include <scsi/scsi_host.h>
22#include <linux/libata.h>
23
24#define DRV_NAME "pata_pdc202xx_old"
25#define DRV_VERSION "0.4.3"
26
27static int pdc2026x_cable_detect(struct ata_port *ap)
28{
29 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
30 u16 cis;
31
32 pci_read_config_word(pdev, 0x50, &cis);
33 if (cis & (1 << (10 + ap->port_no)))
34 return ATA_CBL_PATA40;
35 return ATA_CBL_PATA80;
36}
37
38
39
40
41
42
43
44
45
46
47
48
49static void pdc202xx_configure_piomode(struct ata_port *ap, struct ata_device *adev, int pio)
50{
51 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
52 int port = 0x60 + 8 * ap->port_no + 4 * adev->devno;
53 static u16 pio_timing[5] = {
54 0x0913, 0x050C , 0x0308, 0x0206, 0x0104
55 };
56 u8 r_ap, r_bp;
57
58 pci_read_config_byte(pdev, port, &r_ap);
59 pci_read_config_byte(pdev, port + 1, &r_bp);
60 r_ap &= ~0x3F;
61 r_bp &= ~0x1F;
62 r_ap |= (pio_timing[pio] >> 8);
63 r_bp |= (pio_timing[pio] & 0xFF);
64
65 if (ata_pio_need_iordy(adev))
66 r_ap |= 0x20;
67 if (adev->class == ATA_DEV_ATA)
68 r_ap |= 0x10;
69 pci_write_config_byte(pdev, port, r_ap);
70 pci_write_config_byte(pdev, port + 1, r_bp);
71}
72
73
74
75
76
77
78
79
80
81
82static void pdc202xx_set_piomode(struct ata_port *ap, struct ata_device *adev)
83{
84 pdc202xx_configure_piomode(ap, adev, adev->pio_mode - XFER_PIO_0);
85}
86
87
88
89
90
91
92
93
94
95
96static void pdc202xx_set_dmamode(struct ata_port *ap, struct ata_device *adev)
97{
98 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
99 int port = 0x60 + 8 * ap->port_no + 4 * adev->devno;
100 static u8 udma_timing[6][2] = {
101 { 0x60, 0x03 },
102 { 0x40, 0x02 },
103 { 0x20, 0x01 },
104 { 0x40, 0x02 },
105 { 0x20, 0x01 },
106 { 0x20, 0x01 }
107 };
108 static u8 mdma_timing[3][2] = {
109 { 0xe0, 0x0f },
110 { 0x60, 0x04 },
111 { 0x60, 0x03 },
112 };
113 u8 r_bp, r_cp;
114
115 pci_read_config_byte(pdev, port + 1, &r_bp);
116 pci_read_config_byte(pdev, port + 2, &r_cp);
117
118 r_bp &= ~0xE0;
119 r_cp &= ~0x0F;
120
121 if (adev->dma_mode >= XFER_UDMA_0) {
122 int speed = adev->dma_mode - XFER_UDMA_0;
123 r_bp |= udma_timing[speed][0];
124 r_cp |= udma_timing[speed][1];
125
126 } else {
127 int speed = adev->dma_mode - XFER_MW_DMA_0;
128 r_bp |= mdma_timing[speed][0];
129 r_cp |= mdma_timing[speed][1];
130 }
131 pci_write_config_byte(pdev, port + 1, r_bp);
132 pci_write_config_byte(pdev, port + 2, r_cp);
133
134}
135
136
137
138
139
140
141
142
143
144
145
146
147static void pdc2026x_bmdma_start(struct ata_queued_cmd *qc)
148{
149 struct ata_port *ap = qc->ap;
150 struct ata_device *adev = qc->dev;
151 struct ata_taskfile *tf = &qc->tf;
152 int sel66 = ap->port_no ? 0x08: 0x02;
153
154 void __iomem *master = ap->host->ports[0]->ioaddr.bmdma_addr;
155 void __iomem *clock = master + 0x11;
156 void __iomem *atapi_reg = master + 0x20 + (4 * ap->port_no);
157
158 u32 len;
159
160
161 if (adev->dma_mode > XFER_UDMA_2)
162 iowrite8(ioread8(clock) | sel66, clock);
163 else
164 iowrite8(ioread8(clock) & ~sel66, clock);
165
166
167
168 pdc202xx_set_dmamode(ap, qc->dev);
169
170
171 if ((tf->flags & ATA_TFLAG_LBA48) || tf->protocol == ATAPI_PROT_DMA) {
172 len = qc->nbytes / 2;
173
174 if (tf->flags & ATA_TFLAG_WRITE)
175 len |= 0x06000000;
176 else
177 len |= 0x05000000;
178
179 iowrite32(len, atapi_reg);
180 }
181
182
183 ata_bmdma_start(qc);
184}
185
186
187
188
189
190
191
192
193
194
195
196
197static void pdc2026x_bmdma_stop(struct ata_queued_cmd *qc)
198{
199 struct ata_port *ap = qc->ap;
200 struct ata_device *adev = qc->dev;
201 struct ata_taskfile *tf = &qc->tf;
202
203 int sel66 = ap->port_no ? 0x08: 0x02;
204
205 void __iomem *master = ap->host->ports[0]->ioaddr.bmdma_addr;
206 void __iomem *clock = master + 0x11;
207 void __iomem *atapi_reg = master + 0x20 + (4 * ap->port_no);
208
209
210 if (tf->protocol == ATAPI_PROT_DMA || (tf->flags & ATA_TFLAG_LBA48)) {
211 iowrite32(0, atapi_reg);
212 iowrite8(ioread8(clock) & ~sel66, clock);
213 }
214
215 if (adev->dma_mode > XFER_UDMA_2)
216 iowrite8(ioread8(clock) & ~sel66, clock);
217 ata_bmdma_stop(qc);
218 pdc202xx_set_piomode(ap, adev);
219}
220
221
222
223
224
225
226
227
228
229
230static void pdc2026x_dev_config(struct ata_device *adev)
231{
232 adev->max_sectors = 256;
233}
234
235static int pdc2026x_port_start(struct ata_port *ap)
236{
237 void __iomem *bmdma = ap->ioaddr.bmdma_addr;
238 if (bmdma) {
239
240 u8 burst = ioread8(bmdma + 0x1f);
241 iowrite8(burst | 0x01, bmdma + 0x1f);
242 }
243 return ata_sff_port_start(ap);
244}
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259static int pdc2026x_check_atapi_dma(struct ata_queued_cmd *qc)
260{
261 return 1;
262}
263
264static struct scsi_host_template pdc202xx_sht = {
265 ATA_BMDMA_SHT(DRV_NAME),
266};
267
268static struct ata_port_operations pdc2024x_port_ops = {
269 .inherits = &ata_bmdma_port_ops,
270
271 .cable_detect = ata_cable_40wire,
272 .set_piomode = pdc202xx_set_piomode,
273 .set_dmamode = pdc202xx_set_dmamode,
274};
275
276static struct ata_port_operations pdc2026x_port_ops = {
277 .inherits = &pdc2024x_port_ops,
278
279 .check_atapi_dma = pdc2026x_check_atapi_dma,
280 .bmdma_start = pdc2026x_bmdma_start,
281 .bmdma_stop = pdc2026x_bmdma_stop,
282
283 .cable_detect = pdc2026x_cable_detect,
284 .dev_config = pdc2026x_dev_config,
285
286 .port_start = pdc2026x_port_start,
287};
288
289static int pdc202xx_init_one(struct pci_dev *dev, const struct pci_device_id *id)
290{
291 static const struct ata_port_info info[3] = {
292 {
293 .flags = ATA_FLAG_SLAVE_POSS,
294 .pio_mask = ATA_PIO4,
295 .mwdma_mask = ATA_MWDMA2,
296 .udma_mask = ATA_UDMA2,
297 .port_ops = &pdc2024x_port_ops
298 },
299 {
300 .flags = ATA_FLAG_SLAVE_POSS,
301 .pio_mask = ATA_PIO4,
302 .mwdma_mask = ATA_MWDMA2,
303 .udma_mask = ATA_UDMA4,
304 .port_ops = &pdc2026x_port_ops
305 },
306 {
307 .flags = ATA_FLAG_SLAVE_POSS,
308 .pio_mask = ATA_PIO4,
309 .mwdma_mask = ATA_MWDMA2,
310 .udma_mask = ATA_UDMA5,
311 .port_ops = &pdc2026x_port_ops
312 }
313
314 };
315 const struct ata_port_info *ppi[] = { &info[id->driver_data], NULL };
316
317 if (dev->device == PCI_DEVICE_ID_PROMISE_20265) {
318 struct pci_dev *bridge = dev->bus->self;
319
320 if (bridge && bridge->vendor == PCI_VENDOR_ID_INTEL) {
321 if (bridge->device == PCI_DEVICE_ID_INTEL_I960)
322 return -ENODEV;
323 if (bridge->device == PCI_DEVICE_ID_INTEL_I960RM)
324 return -ENODEV;
325 }
326 }
327 return ata_pci_sff_init_one(dev, ppi, &pdc202xx_sht, NULL);
328}
329
330static const struct pci_device_id pdc202xx[] = {
331 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20246), 0 },
332 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20262), 1 },
333 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20263), 1 },
334 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20265), 2 },
335 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20267), 2 },
336
337 { },
338};
339
340static struct pci_driver pdc202xx_pci_driver = {
341 .name = DRV_NAME,
342 .id_table = pdc202xx,
343 .probe = pdc202xx_init_one,
344 .remove = ata_pci_remove_one,
345#ifdef CONFIG_PM
346 .suspend = ata_pci_device_suspend,
347 .resume = ata_pci_device_resume,
348#endif
349};
350
351static int __init pdc202xx_init(void)
352{
353 return pci_register_driver(&pdc202xx_pci_driver);
354}
355
356static void __exit pdc202xx_exit(void)
357{
358 pci_unregister_driver(&pdc202xx_pci_driver);
359}
360
361MODULE_AUTHOR("Alan Cox");
362MODULE_DESCRIPTION("low-level driver for Promise 2024x and 20262-20267");
363MODULE_LICENSE("GPL");
364MODULE_DEVICE_TABLE(pci, pdc202xx);
365MODULE_VERSION(DRV_VERSION);
366
367module_init(pdc202xx_init);
368module_exit(pdc202xx_exit);
369