1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/config.h>
22#include <linux/module.h>
23#include <linux/types.h>
24#include <linux/kernel.h>
25#include <linux/pci.h>
26#include <linux/init.h>
27#include <linux/timer.h>
28#include <linux/mm.h>
29#include <linux/interrupt.h>
30#include <linux/ide.h>
31
32#include <asm/io.h>
33#include <asm/irq.h>
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50static ide_hwif_t *ide_match_hwif(unsigned long io_base, u8 bootable, const char *name)
51{
52 int h;
53 ide_hwif_t *hwif;
54
55
56
57
58
59 for (h = 0; h < MAX_HWIFS; ++h) {
60 hwif = &ide_hwifs[h];
61 if (hwif->io_ports[IDE_DATA_OFFSET] == io_base) {
62 if (hwif->chipset == ide_generic)
63 return hwif;
64 }
65 }
66
67
68
69
70
71 for (h = 0; h < MAX_HWIFS; ++h) {
72 hwif = &ide_hwifs[h];
73 if (hwif->io_ports[IDE_DATA_OFFSET] == io_base) {
74 if (hwif->chipset == ide_unknown)
75 return hwif;
76 printk(KERN_ERR "%s: port 0x%04lx already claimed by %s\n",
77 name, io_base, hwif->name);
78 return NULL;
79 }
80 }
81
82
83
84
85
86
87
88
89
90
91 if (bootable) {
92 for (h = 0; h < MAX_HWIFS; ++h) {
93 hwif = &ide_hwifs[h];
94 if (hwif->chipset == ide_unknown)
95 return hwif;
96 }
97 } else {
98 for (h = 2; h < MAX_HWIFS; ++h) {
99 hwif = ide_hwifs + h;
100 if (hwif->chipset == ide_unknown)
101 return hwif;
102 }
103 }
104 for (h = 0; h < 2; ++h) {
105 hwif = ide_hwifs + h;
106 if (hwif->chipset == ide_unknown)
107 return hwif;
108 }
109 printk(KERN_ERR "%s: too many IDE interfaces, no room in table\n", name);
110 return NULL;
111}
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126static int ide_setup_pci_baseregs (struct pci_dev *dev, const char *name)
127{
128 u8 progif = 0;
129
130
131
132
133 if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
134 (progif & 5) != 5) {
135 if ((progif & 0xa) != 0xa) {
136 printk(KERN_INFO "%s: device not capable of full "
137 "native PCI mode\n", name);
138 return -EOPNOTSUPP;
139 }
140 printk(KERN_INFO "%s: placing both ports into native PCI mode\n", name);
141 (void) pci_write_config_byte(dev, PCI_CLASS_PROG, progif|5);
142 if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
143 (progif & 5) != 5) {
144 printk(KERN_ERR "%s: rewrite of PROGIF failed, wanted "
145 "0x%04x, got 0x%04x\n",
146 name, progif|5, progif);
147 return -EOPNOTSUPP;
148 }
149 }
150 return 0;
151}
152
153#ifdef CONFIG_BLK_DEV_IDEDMA_FORCED
154
155
156
157
158
159
160
161#define DEFAULT_BMIBA 0xe800
162#define DEFAULT_BMCRBA 0xcc00
163#define DEFAULT_BMALIBA 0xd400
164#endif
165
166
167
168
169
170
171
172
173
174
175static unsigned long ide_get_or_set_dma_base (ide_hwif_t *hwif)
176{
177 unsigned long dma_base = 0;
178 struct pci_dev *dev = hwif->pci_dev;
179
180#ifdef CONFIG_BLK_DEV_IDEDMA_FORCED
181 int second_chance = 0;
182
183second_chance_to_dma:
184#endif
185
186 if (hwif->mmio && hwif->dma_base)
187 return hwif->dma_base;
188 else if (hwif->mate && hwif->mate->dma_base) {
189 dma_base = hwif->mate->dma_base - (hwif->channel ? 0 : 8);
190 } else {
191 dma_base = (hwif->mmio) ?
192 ((unsigned long) hwif->hwif_data) :
193 (pci_resource_start(dev, 4));
194 if (!dma_base) {
195 printk(KERN_ERR "%s: dma_base is invalid (0x%04lx)\n",
196 hwif->cds->name, dma_base);
197 dma_base = 0;
198 }
199 }
200
201#ifdef CONFIG_BLK_DEV_IDEDMA_FORCED
202
203 if ((!dma_base) && (!second_chance)) {
204 unsigned long set_bmiba = 0;
205 second_chance++;
206 switch(dev->vendor) {
207 case PCI_VENDOR_ID_AL:
208 set_bmiba = DEFAULT_BMALIBA; break;
209 case PCI_VENDOR_ID_VIA:
210 set_bmiba = DEFAULT_BMCRBA; break;
211 case PCI_VENDOR_ID_INTEL:
212 set_bmiba = DEFAULT_BMIBA; break;
213 default:
214 return dma_base;
215 }
216 pci_write_config_dword(dev, 0x20, set_bmiba|1);
217 goto second_chance_to_dma;
218 }
219#endif
220
221 if (dma_base) {
222 u8 simplex_stat = 0;
223 dma_base += hwif->channel ? 8 : 0;
224
225 switch(dev->device) {
226 case PCI_DEVICE_ID_AL_M5219:
227 case PCI_DEVICE_ID_AL_M5229:
228 case PCI_DEVICE_ID_AMD_VIPER_7409:
229 case PCI_DEVICE_ID_CMD_643:
230 case PCI_DEVICE_ID_SERVERWORKS_CSB5IDE:
231 simplex_stat = hwif->INB(dma_base + 2);
232 hwif->OUTB((simplex_stat&0x60),(dma_base + 2));
233 simplex_stat = hwif->INB(dma_base + 2);
234 if (simplex_stat & 0x80) {
235 printk(KERN_INFO "%s: simplex device: "
236 "DMA forced\n",
237 hwif->cds->name);
238 }
239 break;
240 default:
241
242
243
244
245
246
247
248 simplex_stat = hwif->INB(dma_base + 2);
249 if (simplex_stat & 0x80) {
250
251#if 0
252
253
254
255
256
257
258
259
260 if (!hwif->drives[0].present && !hwif->drives[1].present)
261 {
262 printk(KERN_INFO "%s: simplex device with no drives: DMA disabled\n",
263 hwif->cds->name);
264 dma_base = 0;
265 }
266
267 else
268#endif
269 if(hwif->mate && hwif->mate->dma_base)
270 {
271 printk(KERN_INFO "%s: simplex device: "
272 "DMA disabled\n",
273 hwif->cds->name);
274 dma_base = 0;
275 }
276 }
277 }
278 }
279 return dma_base;
280}
281
282static void ide_setup_pci_noise (struct pci_dev *dev, ide_pci_device_t *d)
283{
284 if ((d->vendor != dev->vendor) && (d->device != dev->device)) {
285 printk(KERN_INFO "%s: unknown IDE controller at PCI slot "
286 "%s, VID=%04x, DID=%04x\n",
287 d->name, dev->slot_name, dev->vendor, dev->device);
288 } else {
289 printk(KERN_INFO "%s: IDE controller at PCI slot %s\n",
290 d->name, dev->slot_name);
291 }
292}
293
294
295
296
297
298
299
300
301
302
303
304
305static int ide_pci_enable(struct pci_dev *dev, ide_pci_device_t *d)
306{
307
308 if (pci_enable_device(dev)) {
309 if (pci_enable_device_bars(dev, 1 << 4)) {
310 printk(KERN_WARNING "%s: (ide_setup_pci_device:) "
311 "Could not enable device.\n", d->name);
312 return -EBUSY;
313 } else
314 printk(KERN_WARNING "%s: Not fully BIOS configured!\n", d->name);
315 }
316
317
318
319
320
321
322 if (pci_set_dma_mask(dev, 0xffffffff)) {
323 printk(KERN_ERR "%s: can't set dma mask\n", d->name);
324 return -EBUSY;
325 }
326
327
328
329 if (pci_request_region(dev, 4, "ide_tmp"))
330 return -EBUSY;
331 pci_release_region(dev, 4);
332
333 return 0;
334}
335
336
337
338
339
340
341
342
343
344
345static int ide_pci_configure(struct pci_dev *dev, ide_pci_device_t *d)
346{
347 u16 pcicmd = 0;
348
349
350
351
352
353
354
355 if (ide_setup_pci_baseregs(dev, d->name) || pci_write_config_word(dev, PCI_COMMAND, pcicmd|PCI_COMMAND_IO))
356 {
357 printk(KERN_INFO "%s: device disabled (BIOS)\n", d->name);
358 return -ENODEV;
359 }
360 if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd)) {
361 printk(KERN_ERR "%s: error accessing PCI regs\n", d->name);
362 return -EIO;
363 }
364 if (!(pcicmd & PCI_COMMAND_IO)) {
365 printk(KERN_ERR "%s: unable to enable IDE controller\n", d->name);
366 return -ENXIO;
367 }
368 return 0;
369}
370
371
372
373
374
375
376
377
378
379
380
381static int ide_pci_check_iomem(struct pci_dev *dev, ide_pci_device_t *d, int bar)
382{
383 ulong flags = pci_resource_flags(dev, bar);
384
385
386 if (!flags || pci_resource_len(dev, bar) == 0)
387 return 0;
388
389
390 if(flags & PCI_BASE_ADDRESS_IO_MASK)
391 return 0;
392
393
394 printk(KERN_ERR "%s: IO baseregs (BIOS) are reported "
395 "as MEM, report to "
396 "<andre@linux-ide.org>.\n", d->name);
397 return -EINVAL;
398}
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414static ide_hwif_t *ide_hwif_configure(struct pci_dev *dev, ide_pci_device_t *d, ide_hwif_t *mate, int port, int irq)
415{
416 unsigned long ctl = 0, base = 0;
417 ide_hwif_t *hwif;
418
419
420 ide_pci_check_iomem(dev, d, 2*port);
421 ide_pci_check_iomem(dev, d, 2*port+1);
422
423 ctl = pci_resource_start(dev, 2*port+1);
424 base = pci_resource_start(dev, 2*port);
425 if ((ctl && !base) || (base && !ctl)) {
426 printk(KERN_ERR "%s: inconsistent baseregs (BIOS) "
427 "for port %d, skipping\n", d->name, port);
428 return NULL;
429 }
430 if (!ctl)
431 {
432
433 ctl = port ? 0x374 : 0x3f4;
434 base = port ? 0x170 : 0x1f0;
435 }
436 if ((hwif = ide_match_hwif(base, d->bootable, d->name)) == NULL)
437 return NULL;
438 if (hwif->io_ports[IDE_DATA_OFFSET] != base) {
439fixup_address:
440 ide_init_hwif_ports(&hwif->hw, base, (ctl | 2), NULL);
441 memcpy(hwif->io_ports, hwif->hw.io_ports, sizeof(hwif->io_ports));
442 hwif->noprobe = !hwif->io_ports[IDE_DATA_OFFSET];
443 } else if (hwif->io_ports[IDE_CONTROL_OFFSET] != (ctl | 2)) {
444 goto fixup_address;
445 }
446 hwif->chipset = ide_pci;
447 hwif->pci_dev = dev;
448 hwif->cds = (struct ide_pci_device_s *) d;
449 hwif->channel = port;
450
451 if (!hwif->irq)
452 hwif->irq = irq;
453 if (mate) {
454 hwif->mate = mate;
455 mate->mate = hwif;
456 }
457 return hwif;
458}
459
460
461
462
463
464
465
466
467
468
469
470
471static void ide_hwif_setup_dma(struct pci_dev *dev, ide_pci_device_t *d, ide_hwif_t *hwif)
472{
473 u16 pcicmd;
474 pci_read_config_word(dev, PCI_COMMAND, &pcicmd);
475
476 if ((d->autodma == AUTODMA) ||
477 ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE &&
478 (dev->class & 0x80))) {
479 unsigned long dma_base = ide_get_or_set_dma_base(hwif);
480 if (dma_base && !(pcicmd & PCI_COMMAND_MASTER)) {
481
482
483
484
485 if (!((d->device == PCI_DEVICE_ID_CYRIX_5530_IDE && d->vendor == PCI_VENDOR_ID_CYRIX)
486 ||(d->device == PCI_DEVICE_ID_NS_SCx200_IDE && d->vendor == PCI_VENDOR_ID_NS)))
487 {
488
489
490
491
492 hwif->autodma = 0;
493 }
494 pci_set_master(dev);
495 if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd) || !(pcicmd & PCI_COMMAND_MASTER)) {
496 printk(KERN_ERR "%s: %s error updating PCICMD\n",
497 hwif->name, d->name);
498 dma_base = 0;
499 }
500 }
501 if (dma_base) {
502 if (d->init_dma) {
503 d->init_dma(hwif, dma_base);
504 } else {
505 ide_setup_dma(hwif, dma_base, 8);
506 }
507 } else {
508 printk(KERN_INFO "%s: %s Bus-Master DMA disabled "
509 "(BIOS)\n", hwif->name, d->name);
510 }
511 }
512}
513
514
515
516
517
518
519
520
521
522
523
524
525
526static int ide_setup_pci_controller(struct pci_dev *dev, ide_pci_device_t *d, int noisy, int *config)
527{
528 int ret = 0;
529 u32 class_rev;
530 u16 pcicmd;
531
532 if (!noautodma)
533 ret = 1;
534
535 if (noisy)
536 ide_setup_pci_noise(dev, d);
537
538 if (ide_pci_enable(dev, d))
539 return -EBUSY;
540
541 if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd)) {
542 printk(KERN_ERR "%s: error accessing PCI regs\n", d->name);
543 return -EIO;
544 }
545 if (!(pcicmd & PCI_COMMAND_IO)) {
546 if (ide_pci_configure(dev, d))
547 return -ENODEV;
548
549 ret = 0;
550 *config = 1;
551 printk(KERN_INFO "%s: device enabled (Linux)\n", d->name);
552 }
553
554 pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
555 class_rev &= 0xff;
556 if (noisy)
557 printk(KERN_INFO "%s: chipset revision %d\n", d->name, class_rev);
558 return ret;
559}
560
561
562
563
564
565
566
567
568
569
570
571static ata_index_t do_ide_setup_pci_device (struct pci_dev *dev, ide_pci_device_t *d, u8 noisy)
572{
573 u32 port, at_least_one_hwif_enabled = 0, autodma = 0;
574 unsigned int pciirq = 0;
575 int tried_config = 0;
576 int drive0_tune, drive1_tune;
577 ata_index_t index;
578 u8 tmp = 0;
579 ide_hwif_t *hwif, *mate = NULL;
580 static int secondpdc = 0;
581
582 index.all = 0xf0f0;
583
584 if((autodma = ide_setup_pci_controller(dev, d, noisy, &tried_config)) < 0)
585 return index;
586
587
588
589
590 pciirq = dev->irq;
591
592 if ((dev->class & ~(0xfa)) != ((PCI_CLASS_STORAGE_IDE << 8) | 5)) {
593 if (noisy)
594 printk(KERN_INFO "%s: not 100%% native mode: "
595 "will probe irqs later\n", d->name);
596
597
598
599
600
601
602 pciirq = (d->init_chipset) ? d->init_chipset(dev, d->name) : 0;
603 } else if (tried_config) {
604 if (noisy)
605 printk(KERN_INFO "%s: will probe irqs later\n", d->name);
606 pciirq = 0;
607 } else if (!pciirq) {
608 if (noisy)
609 printk(KERN_WARNING "%s: bad irq (%d): will probe later\n",
610 d->name, pciirq);
611 pciirq = 0;
612 } else {
613 if (d->init_chipset)
614 d->init_chipset(dev, d->name);
615
616 if (noisy)
617#ifdef __sparc__
618 printk(KERN_INFO "%s: 100%% native mode on irq %s\n",
619 d->name, __irq_itoa(pciirq));
620#else
621 printk(KERN_INFO "%s: 100%% native mode on irq %d\n",
622 d->name, pciirq);
623#endif
624 }
625
626
627
628
629
630 for (port = 0; port <= 1; ++port) {
631 ide_pci_enablebit_t *e = &(d->enablebits[port]);
632
633
634
635
636
637
638
639
640 if (((d->vendor == PCI_VENDOR_ID_PROMISE) &&
641 ((d->device == PCI_DEVICE_ID_PROMISE_20262) ||
642 (d->device == PCI_DEVICE_ID_PROMISE_20265))) &&
643 (secondpdc++==1) && (port==1))
644 goto controller_ok;
645
646 if (e->reg && (pci_read_config_byte(dev, e->reg, &tmp) ||
647 (tmp & e->mask) != e->val))
648 continue;
649controller_ok:
650
651 if (d->channels <= port)
652 return index;
653
654 if ((hwif = ide_hwif_configure(dev, d, mate, port, pciirq)) == NULL)
655 continue;
656
657
658
659
660 if (hwif->channel) {
661 index.b.high = hwif->index;
662 } else {
663 index.b.low = hwif->index;
664 }
665
666
667 if (d->init_iops)
668 d->init_iops(hwif);
669
670 if (d->autodma == NODMA)
671 goto bypass_legacy_dma;
672 if (d->autodma == NOAUTODMA)
673 autodma = 0;
674 if (autodma)
675 hwif->autodma = 1;
676 ide_hwif_setup_dma(dev, d, hwif);
677bypass_legacy_dma:
678
679 drive0_tune = hwif->drives[0].autotune;
680 drive1_tune = hwif->drives[1].autotune;
681
682 if (d->init_hwif)
683
684
685
686 d->init_hwif(hwif);
687
688 mate = hwif;
689 at_least_one_hwif_enabled = 1;
690 }
691 if (!at_least_one_hwif_enabled)
692 printk(KERN_INFO "%s: neither IDE port enabled (BIOS)\n", d->name);
693 return index;
694}
695
696void ide_setup_pci_device (struct pci_dev *dev, ide_pci_device_t *d)
697{
698 do_ide_setup_pci_device(dev, d, 1);
699}
700
701EXPORT_SYMBOL_GPL(ide_setup_pci_device);
702
703void ide_setup_pci_devices (struct pci_dev *dev, struct pci_dev *dev2, ide_pci_device_t *d)
704{
705 do_ide_setup_pci_device(dev, d, 1);
706 do_ide_setup_pci_device(dev2, d, 0);
707}
708
709EXPORT_SYMBOL_GPL(ide_setup_pci_devices);
710
711
712
713
714
715static int pre_init = 1;
716static LIST_HEAD(ide_pci_drivers);
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733int ide_pci_register_driver(struct pci_driver *driver)
734{
735 if(!pre_init)
736 return pci_module_init(driver);
737 list_add_tail(&driver->node, &ide_pci_drivers);
738 return 0;
739}
740
741EXPORT_SYMBOL_GPL(ide_pci_register_driver);
742
743
744
745
746
747
748
749
750
751void ide_pci_unregister_driver(struct pci_driver *driver)
752{
753 if(!pre_init)
754 pci_unregister_driver(driver);
755 else
756 list_del(&driver->node);
757}
758
759EXPORT_SYMBOL_GPL(ide_pci_unregister_driver);
760
761
762
763
764
765
766
767
768
769
770static int __init ide_scan_pcidev(struct pci_dev *dev)
771{
772 struct list_head *l;
773 struct pci_driver *d;
774
775 list_for_each(l, &ide_pci_drivers)
776 {
777 d = list_entry(l, struct pci_driver, node);
778 if(d->id_table)
779 {
780 const struct pci_device_id *id = pci_match_device(d->id_table, dev);
781 if(id != NULL)
782 {
783 if(d->probe(dev, id) >= 0)
784 {
785 dev->driver = d;
786 return 1;
787 }
788 }
789 }
790 }
791 return 0;
792}
793
794
795
796
797
798
799
800
801
802
803void __init ide_scan_pcibus (int scan_direction)
804{
805 struct pci_dev *dev;
806 struct pci_driver *d;
807 struct list_head *l, *n;
808
809 pre_init = 0;
810 if (!scan_direction) {
811 pci_for_each_dev(dev) {
812 ide_scan_pcidev(dev);
813 }
814 } else {
815 pci_for_each_dev_reverse(dev) {
816 ide_scan_pcidev(dev);
817 }
818 }
819
820
821
822
823
824
825 list_for_each_safe(l, n, &ide_pci_drivers)
826 {
827 list_del(l);
828 d = list_entry(l, struct pci_driver, node);
829 pci_register_driver(d);
830 }
831}
832