1
2
3
4
5
6
7
8
9
10
11#include <common.h>
12#include <pci.h>
13#include "isa.h"
14
15#ifdef CONFIG_405GP
16#ifdef CONFIG_PCI
17
18DECLARE_GLOBAL_DATA_PTR;
19
20#include "piix4_pci.h"
21#include "pci_parts.h"
22
23void pci_pip405_write_regs(struct pci_controller *hose, pci_dev_t dev,
24 struct pci_config_table *entry)
25{
26 struct pci_pip405_config_entry *table;
27 int i;
28
29 table = (struct pci_pip405_config_entry*) entry->priv[0];
30
31 for (i=0; table[i].width; i++)
32 {
33#ifdef DEBUG
34 printf("Reg 0x%02X Value 0x%08lX Width %02d written\n",
35 table[i].index, table[i].val, table[i].width);
36#endif
37
38 switch(table[i].width)
39 {
40 case 1: pci_hose_write_config_byte(hose, dev, table[i].index, table[i].val); break;
41 case 2: pci_hose_write_config_word(hose, dev, table[i].index, table[i].val); break;
42 case 4: pci_hose_write_config_dword(hose, dev, table[i].index, table[i].val); break;
43 }
44 }
45}
46
47
48static void pci_pip405_fixup_irq(struct pci_controller *hose, pci_dev_t dev)
49{
50 unsigned char int_line = 0xff;
51 unsigned char pin;
52
53
54
55 if(PCI_DEV(dev)==0)
56 return;
57 pci_hose_read_config_byte(hose, dev, PCI_INTERRUPT_PIN, &pin);
58 if ((pin == 0) || (pin > 4))
59 return;
60
61 int_line = ((PCI_DEV(dev) + (pin-1) + 10) % 4) + 28;
62 pci_hose_write_config_byte(hose, dev, PCI_INTERRUPT_LINE, int_line);
63#ifdef DEBUG
64 printf("Fixup IRQ: dev %d (%x) int line %d 0x%x\n",
65 PCI_DEV(dev),dev,int_line,int_line);
66#endif
67}
68
69extern void pci_405gp_init(struct pci_controller *hose);
70
71
72static struct pci_controller hose = {
73 config_table: pci_pip405_config_table,
74 fixup_irq: pci_pip405_fixup_irq,
75};
76
77
78void pci_init_board(void)
79{
80
81 hose.fixup_irq = pci_pip405_fixup_irq;
82 hose.config_table = pci_pip405_config_table;
83#ifdef DEBUG
84 printf("Init PCI: fixup_irq=%p config_table=%p hose=%p\n",pci_pip405_fixup_irq,pci_pip405_config_table,hose);
85#endif
86 pci_405gp_init(&hose);
87}
88
89#endif
90#endif
91