This source file includes following definitions.
- legacy_probe_add
- legacy_set_mode
- pdc20230_set_piomode
- pdc_data_xfer_vlb
- ht6560a_set_piomode
- ht6560b_set_piomode
- opti_syscfg
- opti82c611a_set_piomode
- opti82c46x_set_piomode
- opti82c46x_qc_issue
- qdi65x0_set_piomode
- qdi_qc_issue
- vlb32_data_xfer
- qdi_port
- winbond_writecfg
- winbond_readcfg
- winbond_set_piomode
- winbond_port
- probe_chip_type
- legacy_init_one
- legacy_check_special_cases
- probe_opti_vlb
- qdi65_identify_port
- probe_qdi_vlb
- legacy_init
- legacy_exit
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
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47 #include <linux/async.h>
48 #include <linux/kernel.h>
49 #include <linux/module.h>
50 #include <linux/pci.h>
51 #include <linux/init.h>
52 #include <linux/blkdev.h>
53 #include <linux/delay.h>
54 #include <scsi/scsi_host.h>
55 #include <linux/ata.h>
56 #include <linux/libata.h>
57 #include <linux/platform_device.h>
58
59 #define DRV_NAME "pata_legacy"
60 #define DRV_VERSION "0.6.5"
61
62 #define NR_HOST 6
63
64 static int all;
65 module_param(all, int, 0444);
66 MODULE_PARM_DESC(all, "Grab all legacy port devices, even if PCI(0=off, 1=on)");
67
68 enum controller {
69 BIOS = 0,
70 SNOOP = 1,
71 PDC20230 = 2,
72 HT6560A = 3,
73 HT6560B = 4,
74 OPTI611A = 5,
75 OPTI46X = 6,
76 QDI6500 = 7,
77 QDI6580 = 8,
78 QDI6580DP = 9,
79 W83759A = 10,
80
81 UNKNOWN = -1
82 };
83
84 struct legacy_data {
85 unsigned long timing;
86 u8 clock[2];
87 u8 last;
88 int fast;
89 enum controller type;
90 struct platform_device *platform_dev;
91 };
92
93 struct legacy_probe {
94 unsigned char *name;
95 unsigned long port;
96 unsigned int irq;
97 unsigned int slot;
98 enum controller type;
99 unsigned long private;
100 };
101
102 struct legacy_controller {
103 const char *name;
104 struct ata_port_operations *ops;
105 unsigned int pio_mask;
106 unsigned int flags;
107 unsigned int pflags;
108 int (*setup)(struct platform_device *, struct legacy_probe *probe,
109 struct legacy_data *data);
110 };
111
112 static int legacy_port[NR_HOST] = { 0x1f0, 0x170, 0x1e8, 0x168, 0x1e0, 0x160 };
113
114 static struct legacy_probe probe_list[NR_HOST];
115 static struct legacy_data legacy_data[NR_HOST];
116 static struct ata_host *legacy_host[NR_HOST];
117 static int nr_legacy_host;
118
119
120 static int probe_all;
121 static int ht6560a;
122 static int ht6560b;
123 static int opti82c611a;
124 static int opti82c46x;
125 static int autospeed;
126 static int pio_mask = ATA_PIO4;
127 static int iordy_mask = 0xFFFFFFFF;
128
129
130 #ifdef CONFIG_PATA_QDI_MODULE
131 static int qdi = 1;
132 #else
133 static int qdi;
134 #endif
135
136 #ifdef CONFIG_PATA_WINBOND_VLB_MODULE
137 static int winbond = 1;
138
139 #else
140 static int winbond;
141
142 #endif
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159 static int legacy_probe_add(unsigned long port, unsigned int irq,
160 enum controller type, unsigned long private)
161 {
162 struct legacy_probe *lp = &probe_list[0];
163 int i;
164 struct legacy_probe *free = NULL;
165
166 for (i = 0; i < NR_HOST; i++) {
167 if (lp->port == 0 && free == NULL)
168 free = lp;
169
170 if (lp->port == port || legacy_port[i] == port) {
171 free = lp;
172 break;
173 }
174 lp++;
175 }
176 if (free == NULL) {
177 printk(KERN_ERR "pata_legacy: Too many interfaces.\n");
178 return -1;
179 }
180
181 free->port = port;
182 free->irq = irq;
183 free->type = type;
184 free->private = private;
185 return 0;
186 }
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202 static int legacy_set_mode(struct ata_link *link, struct ata_device **unused)
203 {
204 struct ata_device *dev;
205
206 ata_for_each_dev(dev, link, ENABLED) {
207 ata_dev_info(dev, "configured for PIO\n");
208 dev->pio_mode = XFER_PIO_0;
209 dev->xfer_mode = XFER_PIO_0;
210 dev->xfer_shift = ATA_SHIFT_PIO;
211 dev->flags |= ATA_DFLAG_PIO;
212 }
213 return 0;
214 }
215
216 static struct scsi_host_template legacy_sht = {
217 ATA_PIO_SHT(DRV_NAME),
218 };
219
220 static const struct ata_port_operations legacy_base_port_ops = {
221 .inherits = &ata_sff_port_ops,
222 .cable_detect = ata_cable_40wire,
223 };
224
225
226
227
228
229
230
231
232
233 static struct ata_port_operations simple_port_ops = {
234 .inherits = &legacy_base_port_ops,
235 .sff_data_xfer = ata_sff_data_xfer32,
236 };
237
238 static struct ata_port_operations legacy_port_ops = {
239 .inherits = &legacy_base_port_ops,
240 .sff_data_xfer = ata_sff_data_xfer32,
241 .set_mode = legacy_set_mode,
242 };
243
244
245
246
247
248
249
250
251
252
253 static void pdc20230_set_piomode(struct ata_port *ap, struct ata_device *adev)
254 {
255 int tries = 5;
256 int pio = adev->pio_mode - XFER_PIO_0;
257 u8 rt;
258 unsigned long flags;
259
260
261
262 local_irq_save(flags);
263
264
265 do {
266 inb(0x1F5);
267 outb(inb(0x1F2) | 0x80, 0x1F2);
268 inb(0x1F2);
269 inb(0x3F6);
270 inb(0x3F6);
271 inb(0x1F2);
272 inb(0x1F2);
273 }
274 while ((inb(0x1F2) & 0x80) && --tries);
275
276 local_irq_restore(flags);
277
278 outb(inb(0x1F4) & 0x07, 0x1F4);
279
280 rt = inb(0x1F3);
281 rt &= 0x07 << (3 * adev->devno);
282 if (pio)
283 rt |= (1 + 3 * pio) << (3 * adev->devno);
284
285 udelay(100);
286 outb(inb(0x1F2) | 0x01, 0x1F2);
287 udelay(100);
288 inb(0x1F5);
289
290 }
291
292 static unsigned int pdc_data_xfer_vlb(struct ata_queued_cmd *qc,
293 unsigned char *buf, unsigned int buflen, int rw)
294 {
295 struct ata_device *dev = qc->dev;
296 struct ata_port *ap = dev->link->ap;
297 int slop = buflen & 3;
298
299
300 if (ata_id_has_dword_io(dev->id) && (slop == 0 || slop == 3)
301 && (ap->pflags & ATA_PFLAG_PIO32)) {
302 unsigned long flags;
303
304 local_irq_save(flags);
305
306
307 ioread8(ap->ioaddr.nsect_addr);
308 ioread8(ap->ioaddr.nsect_addr);
309 ioread8(ap->ioaddr.nsect_addr);
310
311
312 if (rw == READ)
313 ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
314 else
315 iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
316
317 if (unlikely(slop)) {
318 __le32 pad;
319 if (rw == READ) {
320 pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
321 memcpy(buf + buflen - slop, &pad, slop);
322 } else {
323 memcpy(&pad, buf + buflen - slop, slop);
324 iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
325 }
326 buflen += 4 - slop;
327 }
328 local_irq_restore(flags);
329 } else
330 buflen = ata_sff_data_xfer32(qc, buf, buflen, rw);
331
332 return buflen;
333 }
334
335 static struct ata_port_operations pdc20230_port_ops = {
336 .inherits = &legacy_base_port_ops,
337 .set_piomode = pdc20230_set_piomode,
338 .sff_data_xfer = pdc_data_xfer_vlb,
339 };
340
341
342
343
344
345
346
347
348 static void ht6560a_set_piomode(struct ata_port *ap, struct ata_device *adev)
349 {
350 u8 active, recover;
351 struct ata_timing t;
352
353
354 ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
355
356 active = clamp_val(t.active, 2, 15);
357 recover = clamp_val(t.recover, 4, 15);
358
359 inb(0x3E6);
360 inb(0x3E6);
361 inb(0x3E6);
362 inb(0x3E6);
363
364 iowrite8(recover << 4 | active, ap->ioaddr.device_addr);
365 ioread8(ap->ioaddr.status_addr);
366 }
367
368 static struct ata_port_operations ht6560a_port_ops = {
369 .inherits = &legacy_base_port_ops,
370 .set_piomode = ht6560a_set_piomode,
371 };
372
373
374
375
376
377
378
379
380
381
382 static void ht6560b_set_piomode(struct ata_port *ap, struct ata_device *adev)
383 {
384 u8 active, recover;
385 struct ata_timing t;
386
387
388 ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
389
390 active = clamp_val(t.active, 2, 15);
391 recover = clamp_val(t.recover, 2, 16) & 0x0F;
392
393 inb(0x3E6);
394 inb(0x3E6);
395 inb(0x3E6);
396 inb(0x3E6);
397
398 iowrite8(recover << 4 | active, ap->ioaddr.device_addr);
399
400 if (adev->class != ATA_DEV_ATA) {
401 u8 rconf = inb(0x3E6);
402 if (rconf & 0x24) {
403 rconf &= ~0x24;
404 outb(rconf, 0x3E6);
405 }
406 }
407 ioread8(ap->ioaddr.status_addr);
408 }
409
410 static struct ata_port_operations ht6560b_port_ops = {
411 .inherits = &legacy_base_port_ops,
412 .set_piomode = ht6560b_set_piomode,
413 };
414
415
416
417
418
419
420
421
422
423
424
425
426 static u8 opti_syscfg(u8 reg)
427 {
428 unsigned long flags;
429 u8 r;
430
431
432 local_irq_save(flags);
433 outb(reg, 0x22);
434 r = inb(0x24);
435 local_irq_restore(flags);
436 return r;
437 }
438
439
440
441
442
443
444
445 static void opti82c611a_set_piomode(struct ata_port *ap,
446 struct ata_device *adev)
447 {
448 u8 active, recover, setup;
449 struct ata_timing t;
450 struct ata_device *pair = ata_dev_pair(adev);
451 int clock;
452 int khz[4] = { 50000, 40000, 33000, 25000 };
453 u8 rc;
454
455
456 ioread16(ap->ioaddr.error_addr);
457 ioread16(ap->ioaddr.error_addr);
458 iowrite8(3, ap->ioaddr.nsect_addr);
459
460
461 clock = 1000000000 / khz[ioread8(ap->ioaddr.lbah_addr) & 0x03];
462
463
464 ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
465
466
467 if (pair) {
468 struct ata_timing tp;
469 ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
470
471 ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
472 }
473
474 active = clamp_val(t.active, 2, 17) - 2;
475 recover = clamp_val(t.recover, 1, 16) - 1;
476 setup = clamp_val(t.setup, 1, 4) - 1;
477
478
479 rc = ioread8(ap->ioaddr.lbal_addr);
480 rc &= 0x7F;
481 rc |= (adev->devno << 7);
482 iowrite8(rc, ap->ioaddr.lbal_addr);
483
484
485 iowrite8(active << 4 | recover, ap->ioaddr.error_addr);
486
487
488
489 rc = ioread8(ap->ioaddr.device_addr);
490 rc &= 0xC0;
491 rc |= adev->devno;
492 rc |= (setup << 4) | 0x04;
493 iowrite8(rc, ap->ioaddr.device_addr);
494
495
496 iowrite8(active << 4 | recover, ap->ioaddr.data_addr);
497
498
499 rc = ioread8(ap->ioaddr.lbal_addr);
500 rc &= 0x73;
501 rc |= 0x84;
502 iowrite8(rc, ap->ioaddr.lbal_addr);
503
504
505 iowrite8(0x83, ap->ioaddr.nsect_addr);
506 }
507
508
509 static struct ata_port_operations opti82c611a_port_ops = {
510 .inherits = &legacy_base_port_ops,
511 .set_piomode = opti82c611a_set_piomode,
512 };
513
514
515
516
517
518
519
520
521 static void opti82c46x_set_piomode(struct ata_port *ap, struct ata_device *adev)
522 {
523 u8 active, recover, setup;
524 struct ata_timing t;
525 struct ata_device *pair = ata_dev_pair(adev);
526 int clock;
527 int khz[4] = { 50000, 40000, 33000, 25000 };
528 u8 rc;
529 u8 sysclk;
530
531
532 sysclk = (opti_syscfg(0xAC) & 0xC0) >> 6;
533
534
535 ioread16(ap->ioaddr.error_addr);
536 ioread16(ap->ioaddr.error_addr);
537 iowrite8(3, ap->ioaddr.nsect_addr);
538
539
540 clock = 1000000000 / khz[sysclk];
541
542
543 ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
544
545
546 if (pair) {
547 struct ata_timing tp;
548 ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
549
550 ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
551 }
552
553 active = clamp_val(t.active, 2, 17) - 2;
554 recover = clamp_val(t.recover, 1, 16) - 1;
555 setup = clamp_val(t.setup, 1, 4) - 1;
556
557
558 rc = ioread8(ap->ioaddr.lbal_addr);
559 rc &= 0x7F;
560 rc |= (adev->devno << 7);
561 iowrite8(rc, ap->ioaddr.lbal_addr);
562
563
564 iowrite8(active << 4 | recover, ap->ioaddr.error_addr);
565
566
567
568 rc = ioread8(ap->ioaddr.device_addr);
569 rc &= 0xC0;
570 rc |= adev->devno;
571 rc |= (setup << 4) | 0x04;
572 iowrite8(rc, ap->ioaddr.device_addr);
573
574
575 iowrite8(active << 4 | recover, ap->ioaddr.data_addr);
576
577
578 rc = ioread8(ap->ioaddr.lbal_addr);
579 rc &= 0x73;
580 rc |= 0x84;
581 iowrite8(rc, ap->ioaddr.lbal_addr);
582
583
584 iowrite8(0x83, ap->ioaddr.nsect_addr);
585
586
587 ap->host->private_data = ap;
588 }
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605 static unsigned int opti82c46x_qc_issue(struct ata_queued_cmd *qc)
606 {
607 struct ata_port *ap = qc->ap;
608 struct ata_device *adev = qc->dev;
609
610
611
612 if (ap->host->private_data != ap->host
613 && ap->host->private_data != NULL)
614 opti82c46x_set_piomode(ap, adev);
615
616 return ata_sff_qc_issue(qc);
617 }
618
619 static struct ata_port_operations opti82c46x_port_ops = {
620 .inherits = &legacy_base_port_ops,
621 .set_piomode = opti82c46x_set_piomode,
622 .qc_issue = opti82c46x_qc_issue,
623 };
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638 static void qdi65x0_set_piomode(struct ata_port *ap, struct ata_device *adev)
639 {
640 struct ata_timing t;
641 struct legacy_data *ld_qdi = ap->host->private_data;
642 int active, recovery;
643 u8 timing;
644
645
646 ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
647
648 if (ld_qdi->fast) {
649 active = 8 - clamp_val(t.active, 1, 8);
650 recovery = 18 - clamp_val(t.recover, 3, 18);
651 } else {
652 active = 9 - clamp_val(t.active, 2, 9);
653 recovery = 15 - clamp_val(t.recover, 0, 15);
654 }
655 timing = (recovery << 4) | active | 0x08;
656 ld_qdi->clock[adev->devno] = timing;
657
658 if (ld_qdi->type == QDI6580)
659 outb(timing, ld_qdi->timing + 2 * adev->devno);
660 else
661 outb(timing, ld_qdi->timing + 2 * ap->port_no);
662
663
664 if (ld_qdi->type != QDI6500 && adev->class != ATA_DEV_ATA)
665 outb(0x5F, (ld_qdi->timing & 0xFFF0) + 3);
666 }
667
668
669
670
671
672
673
674
675
676 static unsigned int qdi_qc_issue(struct ata_queued_cmd *qc)
677 {
678 struct ata_port *ap = qc->ap;
679 struct ata_device *adev = qc->dev;
680 struct legacy_data *ld_qdi = ap->host->private_data;
681
682 if (ld_qdi->clock[adev->devno] != ld_qdi->last) {
683 if (adev->pio_mode) {
684 ld_qdi->last = ld_qdi->clock[adev->devno];
685 outb(ld_qdi->clock[adev->devno], ld_qdi->timing +
686 2 * ap->port_no);
687 }
688 }
689 return ata_sff_qc_issue(qc);
690 }
691
692 static unsigned int vlb32_data_xfer(struct ata_queued_cmd *qc,
693 unsigned char *buf,
694 unsigned int buflen, int rw)
695 {
696 struct ata_device *adev = qc->dev;
697 struct ata_port *ap = adev->link->ap;
698 int slop = buflen & 3;
699
700 if (ata_id_has_dword_io(adev->id) && (slop == 0 || slop == 3)
701 && (ap->pflags & ATA_PFLAG_PIO32)) {
702 if (rw == WRITE)
703 iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
704 else
705 ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
706
707 if (unlikely(slop)) {
708 __le32 pad;
709 if (rw == WRITE) {
710 memcpy(&pad, buf + buflen - slop, slop);
711 iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
712 } else {
713 pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
714 memcpy(buf + buflen - slop, &pad, slop);
715 }
716 }
717 return (buflen + 3) & ~3;
718 } else
719 return ata_sff_data_xfer(qc, buf, buflen, rw);
720 }
721
722 static int qdi_port(struct platform_device *dev,
723 struct legacy_probe *lp, struct legacy_data *ld)
724 {
725 if (devm_request_region(&dev->dev, lp->private, 4, "qdi") == NULL)
726 return -EBUSY;
727 ld->timing = lp->private;
728 return 0;
729 }
730
731 static struct ata_port_operations qdi6500_port_ops = {
732 .inherits = &legacy_base_port_ops,
733 .set_piomode = qdi65x0_set_piomode,
734 .qc_issue = qdi_qc_issue,
735 .sff_data_xfer = vlb32_data_xfer,
736 };
737
738 static struct ata_port_operations qdi6580_port_ops = {
739 .inherits = &legacy_base_port_ops,
740 .set_piomode = qdi65x0_set_piomode,
741 .sff_data_xfer = vlb32_data_xfer,
742 };
743
744 static struct ata_port_operations qdi6580dp_port_ops = {
745 .inherits = &legacy_base_port_ops,
746 .set_piomode = qdi65x0_set_piomode,
747 .qc_issue = qdi_qc_issue,
748 .sff_data_xfer = vlb32_data_xfer,
749 };
750
751 static DEFINE_SPINLOCK(winbond_lock);
752
753 static void winbond_writecfg(unsigned long port, u8 reg, u8 val)
754 {
755 unsigned long flags;
756 spin_lock_irqsave(&winbond_lock, flags);
757 outb(reg, port + 0x01);
758 outb(val, port + 0x02);
759 spin_unlock_irqrestore(&winbond_lock, flags);
760 }
761
762 static u8 winbond_readcfg(unsigned long port, u8 reg)
763 {
764 u8 val;
765
766 unsigned long flags;
767 spin_lock_irqsave(&winbond_lock, flags);
768 outb(reg, port + 0x01);
769 val = inb(port + 0x02);
770 spin_unlock_irqrestore(&winbond_lock, flags);
771
772 return val;
773 }
774
775 static void winbond_set_piomode(struct ata_port *ap, struct ata_device *adev)
776 {
777 struct ata_timing t;
778 struct legacy_data *ld_winbond = ap->host->private_data;
779 int active, recovery;
780 u8 reg;
781 int timing = 0x88 + (ap->port_no * 4) + (adev->devno * 2);
782
783 reg = winbond_readcfg(ld_winbond->timing, 0x81);
784
785
786 if (reg & 0x40)
787 ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
788 else
789 ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
790
791 active = (clamp_val(t.active, 3, 17) - 1) & 0x0F;
792 recovery = (clamp_val(t.recover, 1, 15) + 1) & 0x0F;
793 timing = (active << 4) | recovery;
794 winbond_writecfg(ld_winbond->timing, timing, reg);
795
796
797
798 reg = 0x35;
799 if (adev->class != ATA_DEV_ATA)
800 reg |= 0x08;
801 if (!ata_pio_need_iordy(adev))
802 reg |= 0x02;
803 reg |= (clamp_val(t.setup, 0, 3) << 6);
804 winbond_writecfg(ld_winbond->timing, timing + 1, reg);
805 }
806
807 static int winbond_port(struct platform_device *dev,
808 struct legacy_probe *lp, struct legacy_data *ld)
809 {
810 if (devm_request_region(&dev->dev, lp->private, 4, "winbond") == NULL)
811 return -EBUSY;
812 ld->timing = lp->private;
813 return 0;
814 }
815
816 static struct ata_port_operations winbond_port_ops = {
817 .inherits = &legacy_base_port_ops,
818 .set_piomode = winbond_set_piomode,
819 .sff_data_xfer = vlb32_data_xfer,
820 };
821
822 static struct legacy_controller controllers[] = {
823 {"BIOS", &legacy_port_ops, ATA_PIO4,
824 ATA_FLAG_NO_IORDY, 0, NULL },
825 {"Snooping", &simple_port_ops, ATA_PIO4,
826 0, 0, NULL },
827 {"PDC20230", &pdc20230_port_ops, ATA_PIO2,
828 ATA_FLAG_NO_IORDY,
829 ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, NULL },
830 {"HT6560A", &ht6560a_port_ops, ATA_PIO2,
831 ATA_FLAG_NO_IORDY, 0, NULL },
832 {"HT6560B", &ht6560b_port_ops, ATA_PIO4,
833 ATA_FLAG_NO_IORDY, 0, NULL },
834 {"OPTI82C611A", &opti82c611a_port_ops, ATA_PIO3,
835 0, 0, NULL },
836 {"OPTI82C46X", &opti82c46x_port_ops, ATA_PIO3,
837 0, 0, NULL },
838 {"QDI6500", &qdi6500_port_ops, ATA_PIO2,
839 ATA_FLAG_NO_IORDY,
840 ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
841 {"QDI6580", &qdi6580_port_ops, ATA_PIO4,
842 0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
843 {"QDI6580DP", &qdi6580dp_port_ops, ATA_PIO4,
844 0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
845 {"W83759A", &winbond_port_ops, ATA_PIO4,
846 0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,
847 winbond_port }
848 };
849
850
851
852
853
854
855
856
857
858 static __init int probe_chip_type(struct legacy_probe *probe)
859 {
860 int mask = 1 << probe->slot;
861
862 if (winbond && (probe->port == 0x1F0 || probe->port == 0x170)) {
863 u8 reg = winbond_readcfg(winbond, 0x81);
864 reg |= 0x80;
865 winbond_writecfg(winbond, 0x81, reg);
866 reg = winbond_readcfg(winbond, 0x83);
867 reg |= 0xF0;
868 winbond_writecfg(winbond, 0x83, reg);
869 reg = winbond_readcfg(winbond, 0x85);
870 reg |= 0xF0;
871 winbond_writecfg(winbond, 0x85, reg);
872
873 reg = winbond_readcfg(winbond, 0x81);
874
875 if (reg & mask)
876 return W83759A;
877 }
878 if (probe->port == 0x1F0) {
879 unsigned long flags;
880 local_irq_save(flags);
881
882 outb(inb(0x1F2) | 0x80, 0x1F2);
883 inb(0x1F5);
884 inb(0x1F2);
885 inb(0x3F6);
886 inb(0x3F6);
887 inb(0x1F2);
888 inb(0x1F2);
889
890 if ((inb(0x1F2) & 0x80) == 0) {
891
892 printk(KERN_INFO "PDC20230-C/20630 VLB ATA controller"
893 " detected.\n");
894 udelay(100);
895 inb(0x1F5);
896 local_irq_restore(flags);
897 return PDC20230;
898 } else {
899 outb(0x55, 0x1F2);
900 inb(0x1F2);
901 inb(0x1F2);
902 if (inb(0x1F2) == 0x00)
903 printk(KERN_INFO "PDC20230-B VLB ATA "
904 "controller detected.\n");
905 local_irq_restore(flags);
906 return BIOS;
907 }
908 }
909
910 if (ht6560a & mask)
911 return HT6560A;
912 if (ht6560b & mask)
913 return HT6560B;
914 if (opti82c611a & mask)
915 return OPTI611A;
916 if (opti82c46x & mask)
917 return OPTI46X;
918 if (autospeed & mask)
919 return SNOOP;
920 return BIOS;
921 }
922
923
924
925
926
927
928
929
930
931
932 static __init int legacy_init_one(struct legacy_probe *probe)
933 {
934 struct legacy_controller *controller = &controllers[probe->type];
935 int pio_modes = controller->pio_mask;
936 unsigned long io = probe->port;
937 u32 mask = (1 << probe->slot);
938 struct ata_port_operations *ops = controller->ops;
939 struct legacy_data *ld = &legacy_data[probe->slot];
940 struct ata_host *host = NULL;
941 struct ata_port *ap;
942 struct platform_device *pdev;
943 struct ata_device *dev;
944 void __iomem *io_addr, *ctrl_addr;
945 u32 iordy = (iordy_mask & mask) ? 0: ATA_FLAG_NO_IORDY;
946 int ret;
947
948 iordy |= controller->flags;
949
950 pdev = platform_device_register_simple(DRV_NAME, probe->slot, NULL, 0);
951 if (IS_ERR(pdev))
952 return PTR_ERR(pdev);
953
954 ret = -EBUSY;
955 if (devm_request_region(&pdev->dev, io, 8, "pata_legacy") == NULL ||
956 devm_request_region(&pdev->dev, io + 0x0206, 1,
957 "pata_legacy") == NULL)
958 goto fail;
959
960 ret = -ENOMEM;
961 io_addr = devm_ioport_map(&pdev->dev, io, 8);
962 ctrl_addr = devm_ioport_map(&pdev->dev, io + 0x0206, 1);
963 if (!io_addr || !ctrl_addr)
964 goto fail;
965 ld->type = probe->type;
966 if (controller->setup)
967 if (controller->setup(pdev, probe, ld) < 0)
968 goto fail;
969 host = ata_host_alloc(&pdev->dev, 1);
970 if (!host)
971 goto fail;
972 ap = host->ports[0];
973
974 ap->ops = ops;
975 ap->pio_mask = pio_modes;
976 ap->flags |= ATA_FLAG_SLAVE_POSS | iordy;
977 ap->pflags |= controller->pflags;
978 ap->ioaddr.cmd_addr = io_addr;
979 ap->ioaddr.altstatus_addr = ctrl_addr;
980 ap->ioaddr.ctl_addr = ctrl_addr;
981 ata_sff_std_ports(&ap->ioaddr);
982 ap->host->private_data = ld;
983
984 ata_port_desc(ap, "cmd 0x%lx ctl 0x%lx", io, io + 0x0206);
985
986 ret = ata_host_activate(host, probe->irq, ata_sff_interrupt, 0,
987 &legacy_sht);
988 if (ret)
989 goto fail;
990 async_synchronize_full();
991 ld->platform_dev = pdev;
992
993
994
995 ret = -ENODEV;
996 ata_for_each_dev(dev, &ap->link, ALL) {
997 if (!ata_dev_absent(dev)) {
998 legacy_host[probe->slot] = host;
999 ld->platform_dev = pdev;
1000 return 0;
1001 }
1002 }
1003 ata_host_detach(host);
1004 fail:
1005 platform_device_unregister(pdev);
1006 return ret;
1007 }
1008
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022 static void __init legacy_check_special_cases(struct pci_dev *p, int *primary,
1023 int *secondary)
1024 {
1025
1026 if (p->vendor == 0x1078 && p->device == 0x0000) {
1027 *primary = *secondary = 1;
1028 return;
1029 }
1030
1031 if (p->vendor == 0x1078 && p->device == 0x0002) {
1032 *primary = *secondary = 1;
1033 return;
1034 }
1035
1036 if (p->vendor == 0x8086 && p->device == 0x1234) {
1037 u16 r;
1038 pci_read_config_word(p, 0x6C, &r);
1039 if (r & 0x8000) {
1040
1041 if (r & 0x4000)
1042 *secondary = 1;
1043 else
1044 *primary = 1;
1045 }
1046 return;
1047 }
1048 }
1049
1050 static __init void probe_opti_vlb(void)
1051 {
1052
1053 static const char *optis[4] = {
1054 "3/463MV", "5MV",
1055 "5MVA", "5MVB"
1056 };
1057 u8 chans = 1;
1058 u8 ctrl = (opti_syscfg(0x30) & 0xC0) >> 6;
1059
1060 opti82c46x = 3;
1061 printk(KERN_INFO DRV_NAME ": Opti 82C46%s chipset support.\n",
1062 optis[ctrl]);
1063 if (ctrl == 3)
1064 chans = (opti_syscfg(0x3F) & 0x20) ? 2 : 1;
1065 ctrl = opti_syscfg(0xAC);
1066
1067
1068 if (ctrl & 8) {
1069 if (chans == 2) {
1070 legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1071 legacy_probe_add(0x170, 15, OPTI46X, 0);
1072 }
1073 if (ctrl & 4)
1074 legacy_probe_add(0x170, 15, OPTI46X, 0);
1075 else
1076 legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1077 } else
1078 legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1079 }
1080
1081 static __init void qdi65_identify_port(u8 r, u8 res, unsigned long port)
1082 {
1083 static const unsigned long ide_port[2] = { 0x170, 0x1F0 };
1084
1085 if ((r & 0xF0) == 0xC0) {
1086
1087 if (r & 8)
1088
1089 return;
1090 legacy_probe_add(ide_port[r & 0x01], 14 + (r & 0x01),
1091 QDI6500, port);
1092 }
1093 if (((r & 0xF0) == 0xA0) || (r & 0xF0) == 0x50) {
1094
1095 if (!request_region(port + 2 , 2, "pata_qdi")) {
1096 release_region(port, 2);
1097 return;
1098 }
1099 res = inb(port + 3);
1100
1101 if (res & 1)
1102 legacy_probe_add(ide_port[r & 0x01], 14 + (r & 0x01),
1103 QDI6580, port);
1104 else {
1105 legacy_probe_add(0x1F0, 14, QDI6580DP, port);
1106
1107 legacy_probe_add(0x170, 15, QDI6580DP, port + 2);
1108 }
1109 release_region(port + 2, 2);
1110 }
1111 }
1112
1113 static __init void probe_qdi_vlb(void)
1114 {
1115 unsigned long flags;
1116 static const unsigned long qd_port[2] = { 0x30, 0xB0 };
1117 int i;
1118
1119
1120
1121
1122
1123 for (i = 0; i < 2; i++) {
1124 unsigned long port = qd_port[i];
1125 u8 r, res;
1126
1127
1128 if (request_region(port, 2, "pata_qdi")) {
1129
1130 local_irq_save(flags);
1131
1132
1133 r = inb(port);
1134 udelay(1);
1135 outb(0x19, port);
1136 udelay(1);
1137 res = inb(port);
1138 udelay(1);
1139 outb(r, port);
1140 udelay(1);
1141 local_irq_restore(flags);
1142
1143
1144 if (res == 0x19) {
1145 release_region(port, 2);
1146 continue;
1147 }
1148
1149 r = inb(port + 1);
1150 udelay(1);
1151
1152 if ((r & 2) >> 1 == i)
1153 qdi65_identify_port(r, res, port);
1154 release_region(port, 2);
1155 }
1156 }
1157 }
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169 static __init int legacy_init(void)
1170 {
1171 int i;
1172 int ct = 0;
1173 int primary = 0;
1174 int secondary = 0;
1175 int pci_present = 0;
1176 struct legacy_probe *pl = &probe_list[0];
1177 int slot = 0;
1178
1179 struct pci_dev *p = NULL;
1180
1181 for_each_pci_dev(p) {
1182 int r;
1183
1184
1185
1186 for (r = 0; r < 6; r++) {
1187 if (pci_resource_start(p, r) == 0x1f0)
1188 primary = 1;
1189 if (pci_resource_start(p, r) == 0x170)
1190 secondary = 1;
1191 }
1192
1193 legacy_check_special_cases(p, &primary, &secondary);
1194
1195
1196
1197 pci_present = 1;
1198 }
1199
1200 if (winbond == 1)
1201 winbond = 0x130;
1202
1203 if (primary == 0 || all)
1204 legacy_probe_add(0x1F0, 14, UNKNOWN, 0);
1205 if (secondary == 0 || all)
1206 legacy_probe_add(0x170, 15, UNKNOWN, 0);
1207
1208 if (probe_all || !pci_present) {
1209
1210 legacy_probe_add(0x1E8, 11, UNKNOWN, 0);
1211 legacy_probe_add(0x168, 10, UNKNOWN, 0);
1212 legacy_probe_add(0x1E0, 8, UNKNOWN, 0);
1213 legacy_probe_add(0x160, 12, UNKNOWN, 0);
1214 }
1215
1216 if (opti82c46x)
1217 probe_opti_vlb();
1218 if (qdi)
1219 probe_qdi_vlb();
1220
1221 for (i = 0; i < NR_HOST; i++, pl++) {
1222 if (pl->port == 0)
1223 continue;
1224 if (pl->type == UNKNOWN)
1225 pl->type = probe_chip_type(pl);
1226 pl->slot = slot++;
1227 if (legacy_init_one(pl) == 0)
1228 ct++;
1229 }
1230 if (ct != 0)
1231 return 0;
1232 return -ENODEV;
1233 }
1234
1235 static __exit void legacy_exit(void)
1236 {
1237 int i;
1238
1239 for (i = 0; i < nr_legacy_host; i++) {
1240 struct legacy_data *ld = &legacy_data[i];
1241 ata_host_detach(legacy_host[i]);
1242 platform_device_unregister(ld->platform_dev);
1243 }
1244 }
1245
1246 MODULE_AUTHOR("Alan Cox");
1247 MODULE_DESCRIPTION("low-level driver for legacy ATA");
1248 MODULE_LICENSE("GPL");
1249 MODULE_VERSION(DRV_VERSION);
1250 MODULE_ALIAS("pata_qdi");
1251 MODULE_ALIAS("pata_winbond");
1252
1253 module_param(probe_all, int, 0);
1254 module_param(autospeed, int, 0);
1255 module_param(ht6560a, int, 0);
1256 module_param(ht6560b, int, 0);
1257 module_param(opti82c611a, int, 0);
1258 module_param(opti82c46x, int, 0);
1259 module_param(qdi, int, 0);
1260 module_param(winbond, int, 0);
1261 module_param(pio_mask, int, 0);
1262 module_param(iordy_mask, int, 0);
1263
1264 module_init(legacy_init);
1265 module_exit(legacy_exit);