Subversion Repositories shark

Rev

Rev 587 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
587 giacomo 1
/*
2
 * numa.c - Low-level PCI access for NUMA-Q machines
3
 */
4
 
5
#include <linux/pci.h>
6
#include <linux/init.h>
7
#include "pci.h"
8
 
9
#define BUS2QUAD(global) (mp_bus_id_to_node[global])
10
#define BUS2LOCAL(global) (mp_bus_id_to_local[global])
11
#define QUADLOCAL2BUS(quad,local) (quad_local_to_mp_bus_id[quad][local])
12
 
13
#define PCI_CONF1_MQ_ADDRESS(bus, devfn, reg) \
14
        (0x80000000 | (BUS2LOCAL(bus) << 16) | (devfn << 8) | (reg & ~3))
15
 
16
static int pci_conf1_mq_read (int seg, int bus, int devfn, int reg, int len, u32 *value)
17
{
18
        unsigned long flags;
19
 
20
        if (!value || (bus > MAX_MP_BUSSES) || (devfn > 255) || (reg > 255))
21
                return -EINVAL;
22
 
23
        spin_lock_irqsave(&pci_config_lock, flags);
24
 
25
        outl_quad(PCI_CONF1_MQ_ADDRESS(bus, devfn, reg), 0xCF8, BUS2QUAD(bus));
26
 
27
        switch (len) {
28
        case 1:
29
                *value = inb_quad(0xCFC + (reg & 3), BUS2QUAD(bus));
30
                break;
31
        case 2:
32
                *value = inw_quad(0xCFC + (reg & 2), BUS2QUAD(bus));
33
                break;
34
        case 4:
35
                *value = inl_quad(0xCFC, BUS2QUAD(bus));
36
                break;
37
        }
38
 
39
        spin_unlock_irqrestore(&pci_config_lock, flags);
40
 
41
        return 0;
42
}
43
 
44
static int pci_conf1_mq_write (int seg, int bus, int devfn, int reg, int len, u32 value)
45
{
46
        unsigned long flags;
47
 
48
        if ((bus > MAX_MP_BUSSES) || (devfn > 255) || (reg > 255))
49
                return -EINVAL;
50
 
51
        spin_lock_irqsave(&pci_config_lock, flags);
52
 
53
        outl_quad(PCI_CONF1_MQ_ADDRESS(bus, devfn, reg), 0xCF8, BUS2QUAD(bus));
54
 
55
        switch (len) {
56
        case 1:
57
                outb_quad((u8)value, 0xCFC + (reg & 3), BUS2QUAD(bus));
58
                break;
59
        case 2:
60
                outw_quad((u16)value, 0xCFC + (reg & 2), BUS2QUAD(bus));
61
                break;
62
        case 4:
63
                outl_quad((u32)value, 0xCFC, BUS2QUAD(bus));
64
                break;
65
        }
66
 
67
        spin_unlock_irqrestore(&pci_config_lock, flags);
68
 
69
        return 0;
70
}
71
 
72
#undef PCI_CONF1_MQ_ADDRESS
73
 
74
static struct pci_raw_ops pci_direct_conf1_mq = {
75
        .read   = pci_conf1_mq_read,
76
        .write  = pci_conf1_mq_write
77
};
78
 
79
 
80
static void __devinit pci_fixup_i450nx(struct pci_dev *d)
81
{
82
        /*
83
         * i450NX -- Find and scan all secondary buses on all PXB's.
84
         */
85
        int pxb, reg;
86
        u8 busno, suba, subb;
87
        int quad = BUS2QUAD(d->bus->number);
88
 
89
        printk("PCI: Searching for i450NX host bridges on %s\n", pci_name(d));
90
        reg = 0xd0;
91
        for(pxb=0; pxb<2; pxb++) {
92
                pci_read_config_byte(d, reg++, &busno);
93
                pci_read_config_byte(d, reg++, &suba);
94
                pci_read_config_byte(d, reg++, &subb);
95
                DBG("i450NX PXB %d: %02x/%02x/%02x\n", pxb, busno, suba, subb);
96
                if (busno)
97
                        pci_scan_bus(QUADLOCAL2BUS(quad,busno), &pci_root_ops, NULL);   /* Bus A */
98
                if (suba < subb)
99
                        pci_scan_bus(QUADLOCAL2BUS(quad,suba+1), &pci_root_ops, NULL);  /* Bus B */
100
        }
101
        pcibios_last_bus = -1;
102
}
103
 
104
struct pci_fixup pcibios_fixups[] = {
105
        { PCI_FIXUP_HEADER,     PCI_VENDOR_ID_INTEL,    PCI_DEVICE_ID_INTEL_82451NX,    pci_fixup_i450nx },
106
};
107
 
108
static int __init pci_numa_init(void)
109
{
110
        int quad;
111
 
112
        raw_pci_ops = &pci_direct_conf1_mq;
113
 
114
        if (pcibios_scanned++)
115
                return 0;
116
 
117
        pci_root_bus = pcibios_scan_root(0);
118
        if (numnodes > 1) {
119
                for (quad = 1; quad < numnodes; ++quad) {
120
                        printk("Scanning PCI bus %d for quad %d\n",
121
                                QUADLOCAL2BUS(quad,0), quad);
122
                        pci_scan_bus(QUADLOCAL2BUS(quad,0),
123
                                &pci_root_ops, NULL);
124
                }
125
        }
126
        return 0;
127
}
128
 
129
subsys_initcall(pci_numa_init);