arch/x86/kernel/numaq_32.c

   1 /*
   2  * Written by: Patricia Gaughen, IBM Corporation
   3  *
   4  * Copyright (C) 2002, IBM Corp.
   5  *
   6  * All rights reserved.
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful, but
  14  * WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
  16  * NON INFRINGEMENT.  See the GNU General Public License for more
  17  * details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  22  *
  23  * Send feedback to <gone@us.ibm.com>
  24  */
  25
  26 #include <linux/mm.h>
  27 #include <linux/bootmem.h>
  28 #include <linux/mmzone.h>
  29 #include <linux/module.h>
  30 #include <linux/nodemask.h>
  31 #include <asm/numaq.h>
  32 #include <asm/topology.h>
  33 #include <asm/processor.h>
  34 #include <asm/mpspec.h>
  35 #include <asm/e820.h>
  36 #include <asm/setup.h>
  37
  38 #define MB_TO_PAGES(addr) ((addr) << (20 - PAGE_SHIFT))
  39
  40 /*
  41  * Function: smp_dump_qct()
  42  *
  43  * Description: gets memory layout from the quad config table.  This
  44  * function also updates node_online_map with the nodes (quads) present.
  45  */
  46 static void __init smp_dump_qct(void)
  47 {
  48         int node;
  49         struct eachquadmem *eq;
  50         struct sys_cfg_data *scd =
  51                 (struct sys_cfg_data *)__va(SYS_CFG_DATA_PRIV_ADDR);
  52
  53         nodes_clear(node_online_map);
  54         for_each_node(node) {
  55                 if (scd->quads_present31_0 & (1 << node)) {
  56                         node_set_online(node);
  57                         eq = &scd->eq[node];
  58                         /* Convert to pages */
  59                         node_start_pfn[node] = MB_TO_PAGES(
  60                                 eq->hi_shrd_mem_start - eq->priv_mem_size);
  61                         node_end_pfn[node] = MB_TO_PAGES(
  62                                 eq->hi_shrd_mem_start + eq->hi_shrd_mem_size);
  63
  64                         e820_register_active_regions(node, node_start_pfn[node],
  65                                                         node_end_pfn[node]);
  66                         memory_present(node,
  67                                 node_start_pfn[node], node_end_pfn[node]);
  68                         node_remap_size[node] = node_memmap_size_bytes(node,
  69                                                         node_start_pfn[node],
  70                                                         node_end_pfn[node]);
  71                 }
  72         }
  73 }
  74
  75
  76 void __init numaq_tsc_disable(void)
  77 {
  78         if (!found_numaq)
  79                 return;
  80
  81         if (num_online_nodes() > 1) {
  82                 printk(KERN_DEBUG "NUMAQ: disabling TSC\n");
  83                 setup_clear_cpu_cap(X86_FEATURE_TSC);
  84         }
  85 }
  86
  87 static int __init numaq_pre_time_init(void)
  88 {
  89         numaq_tsc_disable();
  90         return 0;
  91 }
  92
  93 int found_numaq;
  94 /*
  95  * Have to match translation table entries to main table entries by counter
  96  * hence the mpc_record variable .... can't see a less disgusting way of
  97  * doing this ....
  98  */
  99 struct mpc_config_translation {
 100         unsigned char mpc_type;
 101         unsigned char trans_len;
 102         unsigned char trans_type;
 103         unsigned char trans_quad;
 104         unsigned char trans_global;
 105         unsigned char trans_local;
 106         unsigned short trans_reserved;
 107 };
 108
 109 /* x86_quirks member */
 110 static int mpc_record;
 111 static struct mpc_config_translation *translation_table[MAX_MPC_ENTRY]
 112     __cpuinitdata;
 113
 114 static inline int generate_logical_apicid(int quad, int phys_apicid)
 115 {
 116         return (quad << 4) + (phys_apicid ? phys_apicid << 1 : 1);
 117 }
 118
 119 /* x86_quirks member */
 120 static int mpc_apic_id(struct mpc_config_processor *m)
 121 {
 122         int quad = translation_table[mpc_record]->trans_quad;
 123         int logical_apicid = generate_logical_apicid(quad, m->mpc_apicid);
 124
 125         printk(KERN_DEBUG "Processor #%d %u:%u APIC version %d (quad %d, apic %d)\n",
 126                m->mpc_apicid,
 127                (m->mpc_cpufeature & CPU_FAMILY_MASK) >> 8,
 128                (m->mpc_cpufeature & CPU_MODEL_MASK) >> 4,
 129                m->mpc_apicver, quad, logical_apicid);
 130         return logical_apicid;
 131 }
 132
 133 int mp_bus_id_to_node[MAX_MP_BUSSES];
 134
 135 int mp_bus_id_to_local[MAX_MP_BUSSES];
 136
 137 /* x86_quirks member */
 138 static void mpc_oem_bus_info(struct mpc_config_bus *m, char *name)
 139 {
 140         int quad = translation_table[mpc_record]->trans_quad;
 141         int local = translation_table[mpc_record]->trans_local;
 142
 143         mp_bus_id_to_node[m->mpc_busid] = quad;
 144         mp_bus_id_to_local[m->mpc_busid] = local;
 145         printk(KERN_INFO "Bus #%d is %s (node %d)\n",
 146                m->mpc_busid, name, quad);
 147 }
 148
 149 int quad_local_to_mp_bus_id [NR_CPUS/4][4];
 150
 151 /* x86_quirks member */
 152 static void mpc_oem_pci_bus(struct mpc_config_bus *m)
 153 {
 154         int quad = translation_table[mpc_record]->trans_quad;
 155         int local = translation_table[mpc_record]->trans_local;
 156
 157         quad_local_to_mp_bus_id[quad][local] = m->mpc_busid;
 158 }
 159
 160 static void __init MP_translation_info(struct mpc_config_translation *m)
 161 {
 162         printk(KERN_INFO
 163                "Translation: record %d, type %d, quad %d, global %d, local %d\n",
 164                mpc_record, m->trans_type, m->trans_quad, m->trans_global,
 165                m->trans_local);
 166
 167         if (mpc_record >= MAX_MPC_ENTRY)
 168                 printk(KERN_ERR "MAX_MPC_ENTRY exceeded!\n");
 169         else
 170                 translation_table[mpc_record] = m;      /* stash this for later */
 171         if (m->trans_quad < MAX_NUMNODES && !node_online(m->trans_quad))
 172                 node_set_online(m->trans_quad);
 173 }
 174
 175 static int __init mpf_checksum(unsigned char *mp, int len)
 176 {
 177         int sum = 0;
 178
 179         while (len--)
 180                 sum += *mp++;
 181
 182         return sum & 0xFF;
 183 }
 184
 185 /*
 186  * Read/parse the MPC oem tables
 187  */
 188
 189 static void __init smp_read_mpc_oem(struct mp_config_oemtable *oemtable,
 190                                     unsigned short oemsize)
 191 {
 192         int count = sizeof(*oemtable);  /* the header size */
 193         unsigned char *oemptr = ((unsigned char *)oemtable) + count;
 194
 195         mpc_record = 0;
 196         printk(KERN_INFO "Found an OEM MPC table at %8p - parsing it ... \n",
 197                oemtable);
 198         if (memcmp(oemtable->oem_signature, MPC_OEM_SIGNATURE, 4)) {
 199                 printk(KERN_WARNING
 200                        "SMP mpc oemtable: bad signature [%c%c%c%c]!\n",
 201                        oemtable->oem_signature[0], oemtable->oem_signature[1],
 202                        oemtable->oem_signature[2], oemtable->oem_signature[3]);
 203                 return;
 204         }
 205         if (mpf_checksum((unsigned char *)oemtable, oemtable->oem_length)) {
 206                 printk(KERN_WARNING "SMP oem mptable: checksum error!\n");
 207                 return;
 208         }
 209         while (count < oemtable->oem_length) {
 210                 switch (*oemptr) {
 211                 case MP_TRANSLATION:
 212                         {
 213                                 struct mpc_config_translation *m =
 214                                     (struct mpc_config_translation *)oemptr;
 215                                 MP_translation_info(m);
 216                                 oemptr += sizeof(*m);
 217                                 count += sizeof(*m);
 218                                 ++mpc_record;
 219                                 break;
 220                         }
 221                 default:
 222                         {
 223                                 printk(KERN_WARNING
 224                                        "Unrecognised OEM table entry type! - %d\n",
 225                                        (int)*oemptr);
 226                                 return;
 227                         }
 228                 }
 229         }
 230 }
 231
 232 static struct x86_quirks numaq_x86_quirks __initdata = {
 233         .arch_pre_time_init     = numaq_pre_time_init,
 234         .arch_time_init         = NULL,
 235         .arch_pre_intr_init     = NULL,
 236         .arch_memory_setup      = NULL,
 237         .arch_intr_init         = NULL,
 238         .arch_trap_init         = NULL,
 239         .mach_get_smp_config    = NULL,
 240         .mach_find_smp_config   = NULL,
 241         .mpc_record             = &mpc_record,
 242         .mpc_apic_id            = mpc_apic_id,
 243         .mpc_oem_bus_info       = mpc_oem_bus_info,
 244         .mpc_oem_pci_bus        = mpc_oem_pci_bus,
 245         .smp_read_mpc_oem       = smp_read_mpc_oem,
 246 };
 247
 248 void numaq_mps_oem_check(struct mp_config_table *mpc, char *oem,
 249                                  char *productid)
 250 {
 251         if (strncmp(oem, "IBM NUMA", 8))
 252                 printk("Warning!  Not a NUMA-Q system!\n");
 253         else
 254                 found_numaq = 1;
 255 }
 256
 257 static __init void early_check_numaq(void)
 258 {
 259         /*
 260          * Find possible boot-time SMP configuration:
 261          */
 262         early_find_smp_config();
 263         /*
 264          * get boot-time SMP configuration:
 265          */
 266         if (smp_found_config)
 267                 early_get_smp_config();
 268
 269         if (found_numaq)
 270                 x86_quirks = &numaq_x86_quirks;
 271 }
 272
 273 int __init get_memcfg_numaq(void)
 274 {
 275         early_check_numaq();
 276         if (!found_numaq)
 277                 return 0;
 278         smp_dump_qct();
 279         return 1;
 280 }