1 files changed, 237 insertions, 0 deletions

diff --git a/arch/x86/mm/amdtopology_64.c b/arch/x86/mm/amdtopology_64.c
new file mode 100644
index 000000000000..51fae9cfdecb
--- /dev/null
+++ b/arch/x86/mm/amdtopology_64.c
@@ -0,0 +1,237 @@
+/*
+ * AMD NUMA support.
+ * Discover the memory map and associated nodes.
+ *
+ * This version reads it directly from the AMD northbridge.
+ *
+ * Copyright 2002,2003 Andi Kleen, SuSE Labs.
+ */
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/string.h>
+#include <linux/module.h>
+#include <linux/nodemask.h>
+#include <linux/memblock.h>
+
+#include <asm/io.h>
+#include <linux/pci_ids.h>
+#include <linux/acpi.h>
+#include <asm/types.h>
+#include <asm/mmzone.h>
+#include <asm/proto.h>
+#include <asm/e820.h>
+#include <asm/pci-direct.h>
+#include <asm/numa.h>
+#include <asm/mpspec.h>
+#include <asm/apic.h>
+#include <asm/amd_nb.h>
+
+static struct bootnode __initdata nodes[8];
+static nodemask_t __initdata nodes_parsed = NODE_MASK_NONE;
+
+static __init int find_northbridge(void)
+{
+        int num;
+
+        for (num = 0; num < 32; num++) {
+                u32 header;
+
+                header = read_pci_config(0, num, 0, 0x00);
+                if (header != (PCI_VENDOR_ID_AMD | (0x1100<<16)) &&
+                        header != (PCI_VENDOR_ID_AMD | (0x1200<<16)) &&
+                        header != (PCI_VENDOR_ID_AMD | (0x1300<<16)))
+                        continue;
+
+                header = read_pci_config(0, num, 1, 0x00);
+                if (header != (PCI_VENDOR_ID_AMD | (0x1101<<16)) &&
+                        header != (PCI_VENDOR_ID_AMD | (0x1201<<16)) &&
+                        header != (PCI_VENDOR_ID_AMD | (0x1301<<16)))
+                        continue;
+                return num;
+        }
+
+        return -1;
+}
+
+static __init void early_get_boot_cpu_id(void)
+{
+        /*
+         * need to get the APIC ID of the BSP so can use that to
+         * create apicid_to_node in amd_scan_nodes()
+         */
+#ifdef CONFIG_X86_MPPARSE
+        /*
+         * get boot-time SMP configuration:
+         */
+        if (smp_found_config)
+                early_get_smp_config();
+#endif
+        early_init_lapic_mapping();
+}
+
+int __init amd_get_nodes(struct bootnode *physnodes)
+{
+        int i;
+        int ret = 0;
+
+        for_each_node_mask(i, nodes_parsed) {
+                physnodes[ret].start = nodes[i].start;
+                physnodes[ret].end = nodes[i].end;
+                ret++;
+        }
+        return ret;
+}
+
+int __init amd_numa_init(unsigned long start_pfn, unsigned long end_pfn)
+{
+        unsigned long start = PFN_PHYS(start_pfn);
+        unsigned long end = PFN_PHYS(end_pfn);
+        unsigned numnodes;
+        unsigned long prevbase;
+        int i, nb, found = 0;
+        u32 nodeid, reg;
+
+        if (!early_pci_allowed())
+                return -1;
+
+        nb = find_northbridge();
+        if (nb < 0)
+                return nb;
+
+        pr_info("Scanning NUMA topology in Northbridge %d\n", nb);
+
+        reg = read_pci_config(0, nb, 0, 0x60);
+        numnodes = ((reg >> 4) & 0xF) + 1;
+        if (numnodes <= 1)
+                return -1;
+
+        pr_info("Number of physical nodes %d\n", numnodes);
+
+        prevbase = 0;
+        for (i = 0; i < 8; i++) {
+                unsigned long base, limit;
+
+                base = read_pci_config(0, nb, 1, 0x40 + i*8);
+                limit = read_pci_config(0, nb, 1, 0x44 + i*8);
+
+                nodeid = limit & 7;
+                if ((base & 3) == 0) {
+                        if (i < numnodes)
+                                pr_info("Skipping disabled node %d\n", i);
+                        continue;
+                }
+                if (nodeid >= numnodes) {
+                        pr_info("Ignoring excess node %d (%lx:%lx)\n", nodeid,
+                                base, limit);
+                        continue;
+                }
+
+                if (!limit) {
+                        pr_info("Skipping node entry %d (base %lx)\n",
+                                i, base);
+                        continue;
+                }
+                if ((base >> 8) & 3 || (limit >> 8) & 3) {
+                        pr_err("Node %d using interleaving mode %lx/%lx\n",
+                               nodeid, (base >> 8) & 3, (limit >> 8) & 3);
+                        return -1;
+                }
+                if (node_isset(nodeid, nodes_parsed)) {
+                        pr_info("Node %d already present, skipping\n",
+                                nodeid);
+                        continue;
+                }
+
+                limit >>= 16;
+                limit <<= 24;
+                limit |= (1<<24)-1;
+                limit++;
+
+                if (limit > end)
+                        limit = end;
+                if (limit <= base)
+                        continue;
+
+                base >>= 16;
+                base <<= 24;
+
+                if (base < start)
+                        base = start;
+                if (limit > end)
+                        limit = end;
+                if (limit == base) {
+                        pr_err("Empty node %d\n", nodeid);
+                        continue;
+                }
+                if (limit < base) {
+                        pr_err("Node %d bogus settings %lx-%lx.\n",
+                               nodeid, base, limit);
+                        continue;
+                }
+
+                /* Could sort here, but pun for now. Should not happen anyroads. */
+                if (prevbase > base) {
+                        pr_err("Node map not sorted %lx,%lx\n",
+                               prevbase, base);
+                        return -1;
+                }
+
+                pr_info("Node %d MemBase %016lx Limit %016lx\n",
+                        nodeid, base, limit);
+
+                found++;
+
+                nodes[nodeid].start = base;
+                nodes[nodeid].end = limit;
+
+                prevbase = base;
+
+                node_set(nodeid, nodes_parsed);
+        }
+
+        if (!found)
+                return -1;
+        return 0;
+}
+
+int __init amd_scan_nodes(void)
+{
+        unsigned int bits;
+        unsigned int cores;
+        unsigned int apicid_base;
+        int i;
+
+        BUG_ON(nodes_empty(nodes_parsed));
+        node_possible_map = nodes_parsed;
+        memnode_shift = compute_hash_shift(nodes, 8, NULL);
+        if (memnode_shift < 0) {
+                pr_err("No NUMA node hash function found. Contact maintainer\n");
+                return -1;
+        }
+        pr_info("Using node hash shift of %d\n", memnode_shift);
+
+        /* use the coreid bits from early_identify_cpu */
+        bits = boot_cpu_data.x86_coreid_bits;
+        cores = (1<<bits);
+        apicid_base = 0;
+        /* get the APIC ID of the BSP early for systems with apicid lifting */
+        early_get_boot_cpu_id();
+        if (boot_cpu_physical_apicid > 0) {
+                pr_info("BSP APIC ID: %02x\n", boot_cpu_physical_apicid);
+                apicid_base = boot_cpu_physical_apicid;
+        }
+
+        for_each_node_mask(i, node_possible_map) {
+                int j;
+
+                memblock_x86_register_active_regions(i,
+                                nodes[i].start >> PAGE_SHIFT,
+                                nodes[i].end >> PAGE_SHIFT);
+                for (j = apicid_base; j < cores + apicid_base; j++)
+                        apicid_to_node[(i << bits) + j] = i;
+                setup_node_bootmem(i, nodes[i].start, nodes[i].end);
+        }
+
+        numa_init_array();
+        return 0;
+}