1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/kernel.h>
20#include <linux/module.h>
21#include <linux/pci.h>
22#include <linux/init.h>
23#include <linux/blkdev.h>
24#include <linux/delay.h>
25#include <linux/device.h>
26#include <scsi/scsi_host.h>
27#include <linux/libata.h>
28#include <linux/ata.h>
29
30#define DRV_NAME "pata_artop"
31#define DRV_VERSION "0.4.5"
32
33
34
35
36
37
38
39
40static int clock = 0;
41
42static int artop6210_pre_reset(struct ata_link *link, unsigned long deadline)
43{
44 struct ata_port *ap = link->ap;
45 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
46 const struct pci_bits artop_enable_bits[] = {
47 { 0x4AU, 1U, 0x02UL, 0x02UL },
48 { 0x4AU, 1U, 0x04UL, 0x04UL },
49 };
50
51 if (!pci_test_config_bits(pdev, &artop_enable_bits[ap->port_no]))
52 return -ENOENT;
53
54 return ata_sff_prereset(link, deadline);
55}
56
57
58
59
60
61
62
63
64
65
66static int artop6260_pre_reset(struct ata_link *link, unsigned long deadline)
67{
68 static const struct pci_bits artop_enable_bits[] = {
69 { 0x4AU, 1U, 0x02UL, 0x02UL },
70 { 0x4AU, 1U, 0x04UL, 0x04UL },
71 };
72
73 struct ata_port *ap = link->ap;
74 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
75
76
77 if (pdev->device % 1 && !pci_test_config_bits(pdev, &artop_enable_bits[ap->port_no]))
78 return -ENOENT;
79
80 return ata_sff_prereset(link, deadline);
81}
82
83
84
85
86
87
88
89
90static int artop6260_cable_detect(struct ata_port *ap)
91{
92 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
93 u8 tmp;
94 pci_read_config_byte(pdev, 0x49, &tmp);
95 if (tmp & (1 << ap->port_no))
96 return ATA_CBL_PATA40;
97 return ATA_CBL_PATA80;
98}
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114static void artop6210_load_piomode(struct ata_port *ap, struct ata_device *adev, unsigned int pio)
115{
116 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
117 int dn = adev->devno + 2 * ap->port_no;
118 const u16 timing[2][5] = {
119 { 0x0000, 0x000A, 0x0008, 0x0303, 0x0301 },
120 { 0x0700, 0x070A, 0x0708, 0x0403, 0x0401 }
121
122 };
123
124 pci_write_config_word(pdev, 0x40 + 2 * dn, timing[clock][pio]);
125}
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141static void artop6210_set_piomode(struct ata_port *ap, struct ata_device *adev)
142{
143 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
144 int dn = adev->devno + 2 * ap->port_no;
145 u8 ultra;
146
147 artop6210_load_piomode(ap, adev, adev->pio_mode - XFER_PIO_0);
148
149
150 pci_read_config_byte(pdev, 0x54, &ultra);
151 ultra &= ~(3 << (2 * dn));
152 pci_write_config_byte(pdev, 0x54, ultra);
153}
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168static void artop6260_load_piomode (struct ata_port *ap, struct ata_device *adev, unsigned int pio)
169{
170 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
171 int dn = adev->devno + 2 * ap->port_no;
172 const u8 timing[2][5] = {
173 { 0x00, 0x0A, 0x08, 0x33, 0x31 },
174 { 0x70, 0x7A, 0x78, 0x43, 0x41 }
175
176 };
177
178 pci_write_config_byte(pdev, 0x40 + dn, timing[clock][pio]);
179}
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195static void artop6260_set_piomode(struct ata_port *ap, struct ata_device *adev)
196{
197 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
198 u8 ultra;
199
200 artop6260_load_piomode(ap, adev, adev->pio_mode - XFER_PIO_0);
201
202
203 pci_read_config_byte(pdev, 0x44 + ap->port_no, &ultra);
204 ultra &= ~(7 << (4 * adev->devno));
205 pci_write_config_byte(pdev, 0x44 + ap->port_no, ultra);
206}
207
208
209
210
211
212
213
214
215
216
217
218
219static void artop6210_set_dmamode (struct ata_port *ap, struct ata_device *adev)
220{
221 unsigned int pio;
222 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
223 int dn = adev->devno + 2 * ap->port_no;
224 u8 ultra;
225
226 if (adev->dma_mode == XFER_MW_DMA_0)
227 pio = 1;
228 else
229 pio = 4;
230
231
232 artop6210_load_piomode(ap, adev, pio);
233
234 pci_read_config_byte(pdev, 0x54, &ultra);
235 ultra &= ~(3 << (2 * dn));
236
237
238 if (adev->dma_mode >= XFER_UDMA_0) {
239 u8 mode = (adev->dma_mode - XFER_UDMA_0) + 1 - clock;
240 if (mode == 0)
241 mode = 1;
242 ultra |= (mode << (2 * dn));
243 }
244 pci_write_config_byte(pdev, 0x54, ultra);
245}
246
247
248
249
250
251
252
253
254
255
256
257
258
259static void artop6260_set_dmamode (struct ata_port *ap, struct ata_device *adev)
260{
261 unsigned int pio = adev->pio_mode - XFER_PIO_0;
262 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
263 u8 ultra;
264
265 if (adev->dma_mode == XFER_MW_DMA_0)
266 pio = 1;
267 else
268 pio = 4;
269
270
271 artop6260_load_piomode(ap, adev, pio);
272
273
274 pci_read_config_byte(pdev, 0x44 + ap->port_no, &ultra);
275 ultra &= ~(7 << (4 * adev->devno));
276 if (adev->dma_mode >= XFER_UDMA_0) {
277 u8 mode = adev->dma_mode - XFER_UDMA_0 + 1 - clock;
278 if (mode == 0)
279 mode = 1;
280 ultra |= (mode << (4 * adev->devno));
281 }
282 pci_write_config_byte(pdev, 0x44 + ap->port_no, ultra);
283}
284
285
286
287
288
289
290
291
292static int artop6210_qc_defer(struct ata_queued_cmd *qc)
293{
294 struct ata_host *host = qc->ap->host;
295 struct ata_port *alt = host->ports[1 ^ qc->ap->port_no];
296 int rc;
297
298
299 rc = ata_std_qc_defer(qc);
300 if (rc != 0)
301 return rc;
302
303
304
305 if (alt && alt->qc_active)
306 return ATA_DEFER_PORT;
307 return 0;
308}
309
310static struct scsi_host_template artop_sht = {
311 ATA_BMDMA_SHT(DRV_NAME),
312};
313
314static struct ata_port_operations artop6210_ops = {
315 .inherits = &ata_bmdma_port_ops,
316 .cable_detect = ata_cable_40wire,
317 .set_piomode = artop6210_set_piomode,
318 .set_dmamode = artop6210_set_dmamode,
319 .prereset = artop6210_pre_reset,
320 .qc_defer = artop6210_qc_defer,
321};
322
323static struct ata_port_operations artop6260_ops = {
324 .inherits = &ata_bmdma_port_ops,
325 .cable_detect = artop6260_cable_detect,
326 .set_piomode = artop6260_set_piomode,
327 .set_dmamode = artop6260_set_dmamode,
328 .prereset = artop6260_pre_reset,
329};
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346static int artop_init_one (struct pci_dev *pdev, const struct pci_device_id *id)
347{
348 static int printed_version;
349 static const struct ata_port_info info_6210 = {
350 .flags = ATA_FLAG_SLAVE_POSS,
351 .pio_mask = ATA_PIO4,
352 .mwdma_mask = ATA_MWDMA2,
353 .udma_mask = ATA_UDMA2,
354 .port_ops = &artop6210_ops,
355 };
356 static const struct ata_port_info info_626x = {
357 .flags = ATA_FLAG_SLAVE_POSS,
358 .pio_mask = ATA_PIO4,
359 .mwdma_mask = ATA_MWDMA2,
360 .udma_mask = ATA_UDMA4,
361 .port_ops = &artop6260_ops,
362 };
363 static const struct ata_port_info info_628x = {
364 .flags = ATA_FLAG_SLAVE_POSS,
365 .pio_mask = ATA_PIO4,
366 .mwdma_mask = ATA_MWDMA2,
367 .udma_mask = ATA_UDMA5,
368 .port_ops = &artop6260_ops,
369 };
370 static const struct ata_port_info info_628x_fast = {
371 .flags = ATA_FLAG_SLAVE_POSS,
372 .pio_mask = ATA_PIO4,
373 .mwdma_mask = ATA_MWDMA2,
374 .udma_mask = ATA_UDMA6,
375 .port_ops = &artop6260_ops,
376 };
377 const struct ata_port_info *ppi[] = { NULL, NULL };
378 int rc;
379
380 if (!printed_version++)
381 dev_printk(KERN_DEBUG, &pdev->dev,
382 "version " DRV_VERSION "\n");
383
384 rc = pcim_enable_device(pdev);
385 if (rc)
386 return rc;
387
388 if (id->driver_data == 0) {
389 ppi[0] = &info_6210;
390
391 pci_write_config_byte(pdev, 0x54, 0);
392 }
393 else if (id->driver_data == 1)
394 ppi[0] = &info_626x;
395 else if (id->driver_data == 2) {
396 unsigned long io = pci_resource_start(pdev, 4);
397 u8 reg;
398
399 ppi[0] = &info_628x;
400 if (inb(io) & 0x10)
401 ppi[0] = &info_628x_fast;
402
403
404
405
406 pci_read_config_byte(pdev, 0x49, ®);
407 pci_write_config_byte(pdev, 0x49, reg & ~ 0x30);
408
409
410
411
412 pci_read_config_byte(pdev, PCI_LATENCY_TIMER, ®);
413 if (reg <= 0x80)
414 pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x90);
415
416
417 pci_read_config_byte(pdev, 0x4a, ®);
418 pci_write_config_byte(pdev, 0x4a, (reg & ~0x01) | 0x80);
419
420 }
421
422 BUG_ON(ppi[0] == NULL);
423
424 return ata_pci_bmdma_init_one(pdev, ppi, &artop_sht, NULL, 0);
425}
426
427static const struct pci_device_id artop_pci_tbl[] = {
428 { PCI_VDEVICE(ARTOP, 0x0005), 0 },
429 { PCI_VDEVICE(ARTOP, 0x0006), 1 },
430 { PCI_VDEVICE(ARTOP, 0x0007), 1 },
431 { PCI_VDEVICE(ARTOP, 0x0008), 2 },
432 { PCI_VDEVICE(ARTOP, 0x0009), 2 },
433
434 { }
435};
436
437static struct pci_driver artop_pci_driver = {
438 .name = DRV_NAME,
439 .id_table = artop_pci_tbl,
440 .probe = artop_init_one,
441 .remove = ata_pci_remove_one,
442};
443
444static int __init artop_init(void)
445{
446 return pci_register_driver(&artop_pci_driver);
447}
448
449static void __exit artop_exit(void)
450{
451 pci_unregister_driver(&artop_pci_driver);
452}
453
454module_init(artop_init);
455module_exit(artop_exit);
456
457MODULE_AUTHOR("Alan Cox");
458MODULE_DESCRIPTION("SCSI low-level driver for ARTOP PATA");
459MODULE_LICENSE("GPL");
460MODULE_DEVICE_TABLE(pci, artop_pci_tbl);
461MODULE_VERSION(DRV_VERSION);
462
463