48645ac120fc3d0b8b7855de1f0d965b5694a2d4
[pandora-kernel.git] / arch / ia64 / sn / kernel / setup.c
1 /*
2  * This file is subject to the terms and conditions of the GNU General Public
3  * License.  See the file "COPYING" in the main directory of this archive
4  * for more details.
5  *
6  * Copyright (C) 1999,2001-2005 Silicon Graphics, Inc. All rights reserved.
7  */
8
9 #include <linux/config.h>
10 #include <linux/module.h>
11 #include <linux/init.h>
12 #include <linux/delay.h>
13 #include <linux/kernel.h>
14 #include <linux/kdev_t.h>
15 #include <linux/string.h>
16 #include <linux/tty.h>
17 #include <linux/console.h>
18 #include <linux/timex.h>
19 #include <linux/sched.h>
20 #include <linux/ioport.h>
21 #include <linux/mm.h>
22 #include <linux/serial.h>
23 #include <linux/irq.h>
24 #include <linux/bootmem.h>
25 #include <linux/mmzone.h>
26 #include <linux/interrupt.h>
27 #include <linux/acpi.h>
28 #include <linux/compiler.h>
29 #include <linux/sched.h>
30 #include <linux/root_dev.h>
31 #include <linux/nodemask.h>
32 #include <linux/pm.h>
33 #include <linux/efi.h>
34
35 #include <asm/io.h>
36 #include <asm/sal.h>
37 #include <asm/machvec.h>
38 #include <asm/system.h>
39 #include <asm/processor.h>
40 #include <asm/vga.h>
41 #include <asm/sn/arch.h>
42 #include <asm/sn/addrs.h>
43 #include <asm/sn/pda.h>
44 #include <asm/sn/nodepda.h>
45 #include <asm/sn/sn_cpuid.h>
46 #include <asm/sn/simulator.h>
47 #include <asm/sn/leds.h>
48 #include <asm/sn/bte.h>
49 #include <asm/sn/shub_mmr.h>
50 #include <asm/sn/clksupport.h>
51 #include <asm/sn/sn_sal.h>
52 #include <asm/sn/geo.h>
53 #include <asm/sn/sn_feature_sets.h>
54 #include "xtalk/xwidgetdev.h"
55 #include "xtalk/hubdev.h"
56 #include <asm/sn/klconfig.h>
57
58
59 DEFINE_PER_CPU(struct pda_s, pda_percpu);
60
61 #define MAX_PHYS_MEMORY         (1UL << IA64_MAX_PHYS_BITS)     /* Max physical address supported */
62
63 extern void bte_init_node(nodepda_t *, cnodeid_t);
64
65 extern void sn_timer_init(void);
66 extern unsigned long last_time_offset;
67 extern void (*ia64_mark_idle) (int);
68 extern void snidle(int);
69 extern unsigned char acpi_kbd_controller_present;
70 extern unsigned long long (*ia64_printk_clock)(void);
71
72 unsigned long sn_rtc_cycles_per_second;
73 EXPORT_SYMBOL(sn_rtc_cycles_per_second);
74
75 DEFINE_PER_CPU(struct sn_hub_info_s, __sn_hub_info);
76 EXPORT_PER_CPU_SYMBOL(__sn_hub_info);
77
78 DEFINE_PER_CPU(short, __sn_cnodeid_to_nasid[MAX_NUMNODES]);
79 EXPORT_PER_CPU_SYMBOL(__sn_cnodeid_to_nasid);
80
81 DEFINE_PER_CPU(struct nodepda_s *, __sn_nodepda);
82 EXPORT_PER_CPU_SYMBOL(__sn_nodepda);
83
84 char sn_system_serial_number_string[128];
85 EXPORT_SYMBOL(sn_system_serial_number_string);
86 u64 sn_partition_serial_number;
87 EXPORT_SYMBOL(sn_partition_serial_number);
88 u8 sn_partition_id;
89 EXPORT_SYMBOL(sn_partition_id);
90 u8 sn_system_size;
91 EXPORT_SYMBOL(sn_system_size);
92 u8 sn_sharing_domain_size;
93 EXPORT_SYMBOL(sn_sharing_domain_size);
94 u8 sn_coherency_id;
95 EXPORT_SYMBOL(sn_coherency_id);
96 u8 sn_region_size;
97 EXPORT_SYMBOL(sn_region_size);
98 int sn_prom_type;       /* 0=hardware, 1=medusa/realprom, 2=medusa/fakeprom */
99
100 short physical_node_map[MAX_NUMALINK_NODES];
101 static unsigned long sn_prom_features[MAX_PROM_FEATURE_SETS];
102
103 EXPORT_SYMBOL(physical_node_map);
104
105 int num_cnodes;
106
107 static void sn_init_pdas(char **);
108 static void build_cnode_tables(void);
109
110 static nodepda_t *nodepdaindr[MAX_COMPACT_NODES];
111
112 /*
113  * The format of "screen_info" is strange, and due to early i386-setup
114  * code. This is just enough to make the console code think we're on a
115  * VGA color display.
116  */
117 struct screen_info sn_screen_info = {
118         .orig_x = 0,
119         .orig_y = 0,
120         .orig_video_mode = 3,
121         .orig_video_cols = 80,
122         .orig_video_ega_bx = 3,
123         .orig_video_lines = 25,
124         .orig_video_isVGA = 1,
125         .orig_video_points = 16
126 };
127
128 /*
129  * This routine can only be used during init, since
130  * smp_boot_data is an init data structure.
131  * We have to use smp_boot_data.cpu_phys_id to find
132  * the physical id of the processor because the normal
133  * cpu_physical_id() relies on data structures that
134  * may not be initialized yet.
135  */
136
137 static int __init pxm_to_nasid(int pxm)
138 {
139         int i;
140         int nid;
141
142         nid = pxm_to_nid_map[pxm];
143         for (i = 0; i < num_node_memblks; i++) {
144                 if (node_memblk[i].nid == nid) {
145                         return NASID_GET(node_memblk[i].start_paddr);
146                 }
147         }
148         return -1;
149 }
150
151 /**
152  * early_sn_setup - early setup routine for SN platforms
153  *
154  * Sets up an initial console to aid debugging.  Intended primarily
155  * for bringup.  See start_kernel() in init/main.c.
156  */
157
158 void __init early_sn_setup(void)
159 {
160         efi_system_table_t *efi_systab;
161         efi_config_table_t *config_tables;
162         struct ia64_sal_systab *sal_systab;
163         struct ia64_sal_desc_entry_point *ep;
164         char *p;
165         int i, j;
166
167         /*
168          * Parse enough of the SAL tables to locate the SAL entry point. Since, console
169          * IO on SN2 is done via SAL calls, early_printk won't work without this.
170          *
171          * This code duplicates some of the ACPI table parsing that is in efi.c & sal.c.
172          * Any changes to those file may have to be made hereas well.
173          */
174         efi_systab = (efi_system_table_t *) __va(ia64_boot_param->efi_systab);
175         config_tables = __va(efi_systab->tables);
176         for (i = 0; i < efi_systab->nr_tables; i++) {
177                 if (efi_guidcmp(config_tables[i].guid, SAL_SYSTEM_TABLE_GUID) ==
178                     0) {
179                         sal_systab = __va(config_tables[i].table);
180                         p = (char *)(sal_systab + 1);
181                         for (j = 0; j < sal_systab->entry_count; j++) {
182                                 if (*p == SAL_DESC_ENTRY_POINT) {
183                                         ep = (struct ia64_sal_desc_entry_point
184                                               *)p;
185                                         ia64_sal_handler_init(__va
186                                                               (ep->sal_proc),
187                                                               __va(ep->gp));
188                                         return;
189                                 }
190                                 p += SAL_DESC_SIZE(*p);
191                         }
192                 }
193         }
194         /* Uh-oh, SAL not available?? */
195         printk(KERN_ERR "failed to find SAL entry point\n");
196 }
197
198 extern int platform_intr_list[];
199 static int __initdata shub_1_1_found;
200
201 /*
202  * sn_check_for_wars
203  *
204  * Set flag for enabling shub specific wars
205  */
206
207 static inline int __init is_shub_1_1(int nasid)
208 {
209         unsigned long id;
210         int rev;
211
212         if (is_shub2())
213                 return 0;
214         id = REMOTE_HUB_L(nasid, SH1_SHUB_ID);
215         rev = (id & SH1_SHUB_ID_REVISION_MASK) >> SH1_SHUB_ID_REVISION_SHFT;
216         return rev <= 2;
217 }
218
219 static void __init sn_check_for_wars(void)
220 {
221         int cnode;
222
223         if (is_shub2()) {
224                 /* none yet */
225         } else {
226                 for_each_online_node(cnode) {
227                         if (is_shub_1_1(cnodeid_to_nasid(cnode)))
228                                 shub_1_1_found = 1;
229                 }
230         }
231 }
232
233 /*
234  * Scan the EFI PCDP table (if it exists) for an acceptable VGA console
235  * output device.  If one exists, pick it and set sn_legacy_{io,mem} to
236  * reflect the bus offsets needed to address it.
237  *
238  * Since pcdp support in SN is not supported in the 2.4 kernel (or at least
239  * the one lbs is based on) just declare the needed structs here.
240  *
241  * Reference spec http://www.dig64.org/specifications/DIG64_PCDPv20.pdf
242  *
243  * Returns 0 if no acceptable vga is found, !0 otherwise.
244  *
245  * Note:  This stuff is duped here because Altix requires the PCDP to
246  * locate a usable VGA device due to lack of proper ACPI support.  Structures
247  * could be used from drivers/firmware/pcdp.h, but it was decided that moving
248  * this file to a more public location just for Altix use was undesireable.
249  */
250
251 struct hcdp_uart_desc {
252         u8      pad[45];
253 };
254
255 struct pcdp {
256         u8      signature[4];   /* should be 'HCDP' */
257         u32     length;
258         u8      rev;            /* should be >=3 for pcdp, <3 for hcdp */
259         u8      sum;
260         u8      oem_id[6];
261         u64     oem_tableid;
262         u32     oem_rev;
263         u32     creator_id;
264         u32     creator_rev;
265         u32     num_type0;
266         struct hcdp_uart_desc uart[0];  /* num_type0 of these */
267         /* pcdp descriptors follow */
268 }  __attribute__((packed));
269
270 struct pcdp_device_desc {
271         u8      type;
272         u8      primary;
273         u16     length;
274         u16     index;
275         /* interconnect specific structure follows */
276         /* device specific structure follows that */
277 }  __attribute__((packed));
278
279 struct pcdp_interface_pci {
280         u8      type;           /* 1 == pci */
281         u8      reserved;
282         u16     length;
283         u8      segment;
284         u8      bus;
285         u8      dev;
286         u8      fun;
287         u16     devid;
288         u16     vendid;
289         u32     acpi_interrupt;
290         u64     mmio_tra;
291         u64     ioport_tra;
292         u8      flags;
293         u8      translation;
294 }  __attribute__((packed));
295
296 struct pcdp_vga_device {
297         u8      num_eas_desc;
298         /* ACPI Extended Address Space Desc follows */
299 }  __attribute__((packed));
300
301 /* from pcdp_device_desc.primary */
302 #define PCDP_PRIMARY_CONSOLE    0x01
303
304 /* from pcdp_device_desc.type */
305 #define PCDP_CONSOLE_INOUT      0x0
306 #define PCDP_CONSOLE_DEBUG      0x1
307 #define PCDP_CONSOLE_OUT        0x2
308 #define PCDP_CONSOLE_IN         0x3
309 #define PCDP_CONSOLE_TYPE_VGA   0x8
310
311 #define PCDP_CONSOLE_VGA        (PCDP_CONSOLE_TYPE_VGA | PCDP_CONSOLE_OUT)
312
313 /* from pcdp_interface_pci.type */
314 #define PCDP_IF_PCI             1
315
316 /* from pcdp_interface_pci.translation */
317 #define PCDP_PCI_TRANS_IOPORT   0x02
318 #define PCDP_PCI_TRANS_MMIO     0x01
319
320 static void
321 sn_scan_pcdp(void)
322 {
323         u8 *bp;
324         struct pcdp *pcdp;
325         struct pcdp_device_desc device;
326         struct pcdp_interface_pci if_pci;
327         extern struct efi efi;
328
329         pcdp = efi.hcdp;
330         if (! pcdp)
331                 return;         /* no hcdp/pcdp table */
332
333         if (pcdp->rev < 3)
334                 return;         /* only support PCDP (rev >= 3) */
335
336         for (bp = (u8 *)&pcdp->uart[pcdp->num_type0];
337              bp < (u8 *)pcdp + pcdp->length;
338              bp += device.length) {
339                 memcpy(&device, bp, sizeof(device));
340                 if (! (device.primary & PCDP_PRIMARY_CONSOLE))
341                         continue;       /* not primary console */
342
343                 if (device.type != PCDP_CONSOLE_VGA)
344                         continue;       /* not VGA descriptor */
345
346                 memcpy(&if_pci, bp+sizeof(device), sizeof(if_pci));
347                 if (if_pci.type != PCDP_IF_PCI)
348                         continue;       /* not PCI interconnect */
349
350                 if (if_pci.translation & PCDP_PCI_TRANS_IOPORT)
351                         vga_console_iobase =
352                                 if_pci.ioport_tra | __IA64_UNCACHED_OFFSET;
353
354                 if (if_pci.translation & PCDP_PCI_TRANS_MMIO)
355                         vga_console_membase =
356                                 if_pci.mmio_tra | __IA64_UNCACHED_OFFSET;
357
358                 break; /* once we find the primary, we're done */
359         }
360 }
361
362 static unsigned long sn2_rtc_initial;
363
364 static unsigned long long ia64_sn2_printk_clock(void)
365 {
366         unsigned long rtc_now = rtc_time();
367
368         return (rtc_now - sn2_rtc_initial) *
369                 (1000000000 / sn_rtc_cycles_per_second);
370 }
371
372 /**
373  * sn_setup - SN platform setup routine
374  * @cmdline_p: kernel command line
375  *
376  * Handles platform setup for SN machines.  This includes determining
377  * the RTC frequency (via a SAL call), initializing secondary CPUs, and
378  * setting up per-node data areas.  The console is also initialized here.
379  */
380 void __init sn_setup(char **cmdline_p)
381 {
382         long status, ticks_per_sec, drift;
383         u32 version = sn_sal_rev();
384         extern void sn_cpu_init(void);
385
386         sn2_rtc_initial = rtc_time();
387         ia64_sn_plat_set_error_handling_features();     // obsolete
388         ia64_sn_set_os_feature(OSF_MCA_SLV_TO_OS_INIT_SLV);
389         ia64_sn_set_os_feature(OSF_FEAT_LOG_SBES);
390
391
392 #if defined(CONFIG_VT) && defined(CONFIG_VGA_CONSOLE)
393         /*
394          * Handle SN vga console.
395          *
396          * SN systems do not have enough ACPI table information
397          * being passed from prom to identify VGA adapters and the legacy
398          * addresses to access them.  Until that is done, SN systems rely
399          * on the PCDP table to identify the primary VGA console if one
400          * exists.
401          *
402          * However, kernel PCDP support is optional, and even if it is built
403          * into the kernel, it will not be used if the boot cmdline contains
404          * console= directives.
405          *
406          * So, to work around this mess, we duplicate some of the PCDP code
407          * here so that the primary VGA console (as defined by PCDP) will
408          * work on SN systems even if a different console (e.g. serial) is
409          * selected on the boot line (or CONFIG_EFI_PCDP is off).
410          */
411
412         if (! vga_console_membase)
413                 sn_scan_pcdp();
414
415         if (vga_console_membase) {
416                 /* usable vga ... make tty0 the preferred default console */
417                 if (!strstr(*cmdline_p, "console="))
418                         add_preferred_console("tty", 0, NULL);
419         } else {
420                 printk(KERN_DEBUG "SGI: Disabling VGA console\n");
421                 if (!strstr(*cmdline_p, "console="))
422                         add_preferred_console("ttySG", 0, NULL);
423 #ifdef CONFIG_DUMMY_CONSOLE
424                 conswitchp = &dummy_con;
425 #else
426                 conswitchp = NULL;
427 #endif                          /* CONFIG_DUMMY_CONSOLE */
428         }
429 #endif                          /* def(CONFIG_VT) && def(CONFIG_VGA_CONSOLE) */
430
431         MAX_DMA_ADDRESS = PAGE_OFFSET + MAX_PHYS_MEMORY;
432
433         /*
434          * Build the tables for managing cnodes.
435          */
436         build_cnode_tables();
437
438         status =
439             ia64_sal_freq_base(SAL_FREQ_BASE_REALTIME_CLOCK, &ticks_per_sec,
440                                &drift);
441         if (status != 0 || ticks_per_sec < 100000) {
442                 printk(KERN_WARNING
443                        "unable to determine platform RTC clock frequency, guessing.\n");
444                 /* PROM gives wrong value for clock freq. so guess */
445                 sn_rtc_cycles_per_second = 1000000000000UL / 30000UL;
446         } else
447                 sn_rtc_cycles_per_second = ticks_per_sec;
448
449         platform_intr_list[ACPI_INTERRUPT_CPEI] = IA64_CPE_VECTOR;
450
451         ia64_printk_clock = ia64_sn2_printk_clock;
452
453         /*
454          * Old PROMs do not provide an ACPI FADT. Disable legacy keyboard
455          * support here so we don't have to listen to failed keyboard probe
456          * messages.
457          */
458         if (version <= 0x0209 && acpi_kbd_controller_present) {
459                 printk(KERN_INFO "Disabling legacy keyboard support as prom "
460                        "is too old and doesn't provide FADT\n");
461                 acpi_kbd_controller_present = 0;
462         }
463
464         printk("SGI SAL version %x.%02x\n", version >> 8, version & 0x00FF);
465
466         /*
467          * we set the default root device to /dev/hda
468          * to make simulation easy
469          */
470         ROOT_DEV = Root_HDA1;
471
472         /*
473          * Create the PDAs and NODEPDAs for all the cpus.
474          */
475         sn_init_pdas(cmdline_p);
476
477         ia64_mark_idle = &snidle;
478
479         /*
480          * For the bootcpu, we do this here. All other cpus will make the
481          * call as part of cpu_init in slave cpu initialization.
482          */
483         sn_cpu_init();
484
485 #ifdef CONFIG_SMP
486         init_smp_config();
487 #endif
488         screen_info = sn_screen_info;
489
490         sn_timer_init();
491
492         /*
493          * set pm_power_off to a SAL call to allow
494          * sn machines to power off. The SAL call can be replaced
495          * by an ACPI interface call when ACPI is fully implemented
496          * for sn.
497          */
498         pm_power_off = ia64_sn_power_down;
499 }
500
501 /**
502  * sn_init_pdas - setup node data areas
503  *
504  * One time setup for Node Data Area.  Called by sn_setup().
505  */
506 static void __init sn_init_pdas(char **cmdline_p)
507 {
508         cnodeid_t cnode;
509
510         /*
511          * Allocate & initalize the nodepda for each node.
512          */
513         for_each_online_node(cnode) {
514                 nodepdaindr[cnode] =
515                     alloc_bootmem_node(NODE_DATA(cnode), sizeof(nodepda_t));
516                 memset(nodepdaindr[cnode], 0, sizeof(nodepda_t));
517                 memset(nodepdaindr[cnode]->phys_cpuid, -1,
518                     sizeof(nodepdaindr[cnode]->phys_cpuid));
519                 spin_lock_init(&nodepdaindr[cnode]->ptc_lock);
520         }
521
522         /*
523          * Allocate & initialize nodepda for TIOs.  For now, put them on node 0.
524          */
525         for (cnode = num_online_nodes(); cnode < num_cnodes; cnode++) {
526                 nodepdaindr[cnode] =
527                     alloc_bootmem_node(NODE_DATA(0), sizeof(nodepda_t));
528                 memset(nodepdaindr[cnode], 0, sizeof(nodepda_t));
529         }
530
531         /*
532          * Now copy the array of nodepda pointers to each nodepda.
533          */
534         for (cnode = 0; cnode < num_cnodes; cnode++)
535                 memcpy(nodepdaindr[cnode]->pernode_pdaindr, nodepdaindr,
536                        sizeof(nodepdaindr));
537
538         /*
539          * Set up IO related platform-dependent nodepda fields.
540          * The following routine actually sets up the hubinfo struct
541          * in nodepda.
542          */
543         for_each_online_node(cnode) {
544                 bte_init_node(nodepdaindr[cnode], cnode);
545         }
546
547         /*
548          * Initialize the per node hubdev.  This includes IO Nodes and
549          * headless/memless nodes.
550          */
551         for (cnode = 0; cnode < num_cnodes; cnode++) {
552                 hubdev_init_node(nodepdaindr[cnode], cnode);
553         }
554 }
555
556 /**
557  * sn_cpu_init - initialize per-cpu data areas
558  * @cpuid: cpuid of the caller
559  *
560  * Called during cpu initialization on each cpu as it starts.
561  * Currently, initializes the per-cpu data area for SNIA.
562  * Also sets up a few fields in the nodepda.  Also known as
563  * platform_cpu_init() by the ia64 machvec code.
564  */
565 void __init sn_cpu_init(void)
566 {
567         int cpuid;
568         int cpuphyid;
569         int nasid;
570         int subnode;
571         int slice;
572         int cnode;
573         int i;
574         static int wars_have_been_checked;
575
576         if (smp_processor_id() == 0 && IS_MEDUSA()) {
577                 if (ia64_sn_is_fake_prom())
578                         sn_prom_type = 2;
579                 else
580                         sn_prom_type = 1;
581                 printk(KERN_INFO "Running on medusa with %s PROM\n",
582                        (sn_prom_type == 1) ? "real" : "fake");
583         }
584
585         memset(pda, 0, sizeof(pda));
586         if (ia64_sn_get_sn_info(0, &sn_hub_info->shub2,
587                                 &sn_hub_info->nasid_bitmask,
588                                 &sn_hub_info->nasid_shift,
589                                 &sn_system_size, &sn_sharing_domain_size,
590                                 &sn_partition_id, &sn_coherency_id,
591                                 &sn_region_size))
592                 BUG();
593         sn_hub_info->as_shift = sn_hub_info->nasid_shift - 2;
594
595         /*
596          * The boot cpu makes this call again after platform initialization is
597          * complete.
598          */
599         if (nodepdaindr[0] == NULL)
600                 return;
601
602         for (i = 0; i < MAX_PROM_FEATURE_SETS; i++)
603                 if (ia64_sn_get_prom_feature_set(i, &sn_prom_features[i]) != 0)
604                         break;
605
606         cpuid = smp_processor_id();
607         cpuphyid = get_sapicid();
608
609         if (ia64_sn_get_sapic_info(cpuphyid, &nasid, &subnode, &slice))
610                 BUG();
611
612         for (i=0; i < MAX_NUMNODES; i++) {
613                 if (nodepdaindr[i]) {
614                         nodepdaindr[i]->phys_cpuid[cpuid].nasid = nasid;
615                         nodepdaindr[i]->phys_cpuid[cpuid].slice = slice;
616                         nodepdaindr[i]->phys_cpuid[cpuid].subnode = subnode;
617                 }
618         }
619
620         cnode = nasid_to_cnodeid(nasid);
621
622         sn_nodepda = nodepdaindr[cnode];
623
624         pda->led_address =
625             (typeof(pda->led_address)) (LED0 + (slice << LED_CPU_SHIFT));
626         pda->led_state = LED_ALWAYS_SET;
627         pda->hb_count = HZ / 2;
628         pda->hb_state = 0;
629         pda->idle_flag = 0;
630
631         if (cpuid != 0) {
632                 /* copy cpu 0's sn_cnodeid_to_nasid table to this cpu's */
633                 memcpy(sn_cnodeid_to_nasid,
634                        (&per_cpu(__sn_cnodeid_to_nasid, 0)),
635                        sizeof(__ia64_per_cpu_var(__sn_cnodeid_to_nasid)));
636         }
637
638         /*
639          * Check for WARs.
640          * Only needs to be done once, on BSP.
641          * Has to be done after loop above, because it uses this cpu's
642          * sn_cnodeid_to_nasid table which was just initialized if this
643          * isn't cpu 0.
644          * Has to be done before assignment below.
645          */
646         if (!wars_have_been_checked) {
647                 sn_check_for_wars();
648                 wars_have_been_checked = 1;
649         }
650         sn_hub_info->shub_1_1_found = shub_1_1_found;
651
652         /*
653          * Set up addresses of PIO/MEM write status registers.
654          */
655         {
656                 u64 pio1[] = {SH1_PIO_WRITE_STATUS_0, 0, SH1_PIO_WRITE_STATUS_1, 0};
657                 u64 pio2[] = {SH2_PIO_WRITE_STATUS_0, SH2_PIO_WRITE_STATUS_2,
658                         SH2_PIO_WRITE_STATUS_1, SH2_PIO_WRITE_STATUS_3};
659                 u64 *pio;
660                 pio = is_shub1() ? pio1 : pio2;
661                 pda->pio_write_status_addr = (volatile unsigned long *) LOCAL_MMR_ADDR(pio[slice]);
662                 pda->pio_write_status_val = is_shub1() ? SH_PIO_WRITE_STATUS_PENDING_WRITE_COUNT_MASK : 0;
663         }
664
665         /*
666          * WAR addresses for SHUB 1.x.
667          */
668         if (local_node_data->active_cpu_count++ == 0 && is_shub1()) {
669                 int buddy_nasid;
670                 buddy_nasid =
671                     cnodeid_to_nasid(numa_node_id() ==
672                                      num_online_nodes() - 1 ? 0 : numa_node_id() + 1);
673                 pda->pio_shub_war_cam_addr =
674                     (volatile unsigned long *)GLOBAL_MMR_ADDR(nasid,
675                                                               SH1_PI_CAM_CONTROL);
676         }
677 }
678
679 /*
680  * Build tables for converting between NASIDs and cnodes.
681  */
682 static inline int __init board_needs_cnode(int type)
683 {
684         return (type == KLTYPE_SNIA || type == KLTYPE_TIO);
685 }
686
687 void __init build_cnode_tables(void)
688 {
689         int nasid;
690         int node;
691         lboard_t *brd;
692
693         memset(physical_node_map, -1, sizeof(physical_node_map));
694         memset(sn_cnodeid_to_nasid, -1,
695                         sizeof(__ia64_per_cpu_var(__sn_cnodeid_to_nasid)));
696
697         /*
698          * First populate the tables with C/M bricks. This ensures that
699          * cnode == node for all C & M bricks.
700          */
701         for_each_online_node(node) {
702                 nasid = pxm_to_nasid(nid_to_pxm_map[node]);
703                 sn_cnodeid_to_nasid[node] = nasid;
704                 physical_node_map[nasid] = node;
705         }
706
707         /*
708          * num_cnodes is total number of C/M/TIO bricks. Because of the 256 node
709          * limit on the number of nodes, we can't use the generic node numbers 
710          * for this. Note that num_cnodes is incremented below as TIOs or
711          * headless/memoryless nodes are discovered.
712          */
713         num_cnodes = num_online_nodes();
714
715         /* fakeprom does not support klgraph */
716         if (IS_RUNNING_ON_FAKE_PROM())
717                 return;
718
719         /* Find TIOs & headless/memoryless nodes and add them to the tables */
720         for_each_online_node(node) {
721                 kl_config_hdr_t *klgraph_header;
722                 nasid = cnodeid_to_nasid(node);
723                 klgraph_header = ia64_sn_get_klconfig_addr(nasid);
724                 if (klgraph_header == NULL)
725                         BUG();
726                 brd = NODE_OFFSET_TO_LBOARD(nasid, klgraph_header->ch_board_info);
727                 while (brd) {
728                         if (board_needs_cnode(brd->brd_type) && physical_node_map[brd->brd_nasid] < 0) {
729                                 sn_cnodeid_to_nasid[num_cnodes] = brd->brd_nasid;
730                                 physical_node_map[brd->brd_nasid] = num_cnodes++;
731                         }
732                         brd = find_lboard_next(brd);
733                 }
734         }
735 }
736
737 int
738 nasid_slice_to_cpuid(int nasid, int slice)
739 {
740         long cpu;
741
742         for (cpu = 0; cpu < NR_CPUS; cpu++)
743                 if (cpuid_to_nasid(cpu) == nasid &&
744                                         cpuid_to_slice(cpu) == slice)
745                         return cpu;
746
747         return -1;
748 }
749
750 int sn_prom_feature_available(int id)
751 {
752         if (id >= BITS_PER_LONG * MAX_PROM_FEATURE_SETS)
753                 return 0;
754         return test_bit(id, sn_prom_features);
755 }
756 EXPORT_SYMBOL(sn_prom_feature_available);
757