Merge master.kernel.org:/pub/scm/linux/kernel/git/jejb/scsi-rc-fixes-2.6
[linux-2.6] / 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_COMPACT_NODES]);
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 #if defined(CONFIG_VT) && defined(CONFIG_VGA_CONSOLE)
321 static void
322 sn_scan_pcdp(void)
323 {
324         u8 *bp;
325         struct pcdp *pcdp;
326         struct pcdp_device_desc device;
327         struct pcdp_interface_pci if_pci;
328         extern struct efi efi;
329
330         pcdp = efi.hcdp;
331         if (! pcdp)
332                 return;         /* no hcdp/pcdp table */
333
334         if (pcdp->rev < 3)
335                 return;         /* only support PCDP (rev >= 3) */
336
337         for (bp = (u8 *)&pcdp->uart[pcdp->num_type0];
338              bp < (u8 *)pcdp + pcdp->length;
339              bp += device.length) {
340                 memcpy(&device, bp, sizeof(device));
341                 if (! (device.primary & PCDP_PRIMARY_CONSOLE))
342                         continue;       /* not primary console */
343
344                 if (device.type != PCDP_CONSOLE_VGA)
345                         continue;       /* not VGA descriptor */
346
347                 memcpy(&if_pci, bp+sizeof(device), sizeof(if_pci));
348                 if (if_pci.type != PCDP_IF_PCI)
349                         continue;       /* not PCI interconnect */
350
351                 if (if_pci.translation & PCDP_PCI_TRANS_IOPORT)
352                         vga_console_iobase =
353                                 if_pci.ioport_tra | __IA64_UNCACHED_OFFSET;
354
355                 if (if_pci.translation & PCDP_PCI_TRANS_MMIO)
356                         vga_console_membase =
357                                 if_pci.mmio_tra | __IA64_UNCACHED_OFFSET;
358
359                 break; /* once we find the primary, we're done */
360         }
361 }
362 #endif
363
364 static unsigned long sn2_rtc_initial;
365
366 static unsigned long long ia64_sn2_printk_clock(void)
367 {
368         unsigned long rtc_now = rtc_time();
369
370         return (rtc_now - sn2_rtc_initial) *
371                 (1000000000 / sn_rtc_cycles_per_second);
372 }
373
374 /**
375  * sn_setup - SN platform setup routine
376  * @cmdline_p: kernel command line
377  *
378  * Handles platform setup for SN machines.  This includes determining
379  * the RTC frequency (via a SAL call), initializing secondary CPUs, and
380  * setting up per-node data areas.  The console is also initialized here.
381  */
382 void __init sn_setup(char **cmdline_p)
383 {
384         long status, ticks_per_sec, drift;
385         u32 version = sn_sal_rev();
386         extern void sn_cpu_init(void);
387
388         sn2_rtc_initial = rtc_time();
389         ia64_sn_plat_set_error_handling_features();     // obsolete
390         ia64_sn_set_os_feature(OSF_MCA_SLV_TO_OS_INIT_SLV);
391         ia64_sn_set_os_feature(OSF_FEAT_LOG_SBES);
392
393
394 #if defined(CONFIG_VT) && defined(CONFIG_VGA_CONSOLE)
395         /*
396          * Handle SN vga console.
397          *
398          * SN systems do not have enough ACPI table information
399          * being passed from prom to identify VGA adapters and the legacy
400          * addresses to access them.  Until that is done, SN systems rely
401          * on the PCDP table to identify the primary VGA console if one
402          * exists.
403          *
404          * However, kernel PCDP support is optional, and even if it is built
405          * into the kernel, it will not be used if the boot cmdline contains
406          * console= directives.
407          *
408          * So, to work around this mess, we duplicate some of the PCDP code
409          * here so that the primary VGA console (as defined by PCDP) will
410          * work on SN systems even if a different console (e.g. serial) is
411          * selected on the boot line (or CONFIG_EFI_PCDP is off).
412          */
413
414         if (! vga_console_membase)
415                 sn_scan_pcdp();
416
417         if (vga_console_membase) {
418                 /* usable vga ... make tty0 the preferred default console */
419                 if (!strstr(*cmdline_p, "console="))
420                         add_preferred_console("tty", 0, NULL);
421         } else {
422                 printk(KERN_DEBUG "SGI: Disabling VGA console\n");
423                 if (!strstr(*cmdline_p, "console="))
424                         add_preferred_console("ttySG", 0, NULL);
425 #ifdef CONFIG_DUMMY_CONSOLE
426                 conswitchp = &dummy_con;
427 #else
428                 conswitchp = NULL;
429 #endif                          /* CONFIG_DUMMY_CONSOLE */
430         }
431 #endif                          /* def(CONFIG_VT) && def(CONFIG_VGA_CONSOLE) */
432
433         MAX_DMA_ADDRESS = PAGE_OFFSET + MAX_PHYS_MEMORY;
434
435         /*
436          * Build the tables for managing cnodes.
437          */
438         build_cnode_tables();
439
440         status =
441             ia64_sal_freq_base(SAL_FREQ_BASE_REALTIME_CLOCK, &ticks_per_sec,
442                                &drift);
443         if (status != 0 || ticks_per_sec < 100000) {
444                 printk(KERN_WARNING
445                        "unable to determine platform RTC clock frequency, guessing.\n");
446                 /* PROM gives wrong value for clock freq. so guess */
447                 sn_rtc_cycles_per_second = 1000000000000UL / 30000UL;
448         } else
449                 sn_rtc_cycles_per_second = ticks_per_sec;
450
451         platform_intr_list[ACPI_INTERRUPT_CPEI] = IA64_CPE_VECTOR;
452
453         ia64_printk_clock = ia64_sn2_printk_clock;
454
455         /*
456          * Old PROMs do not provide an ACPI FADT. Disable legacy keyboard
457          * support here so we don't have to listen to failed keyboard probe
458          * messages.
459          */
460         if (version <= 0x0209 && acpi_kbd_controller_present) {
461                 printk(KERN_INFO "Disabling legacy keyboard support as prom "
462                        "is too old and doesn't provide FADT\n");
463                 acpi_kbd_controller_present = 0;
464         }
465
466         printk("SGI SAL version %x.%02x\n", version >> 8, version & 0x00FF);
467
468         /*
469          * we set the default root device to /dev/hda
470          * to make simulation easy
471          */
472         ROOT_DEV = Root_HDA1;
473
474         /*
475          * Create the PDAs and NODEPDAs for all the cpus.
476          */
477         sn_init_pdas(cmdline_p);
478
479         ia64_mark_idle = &snidle;
480
481         /*
482          * For the bootcpu, we do this here. All other cpus will make the
483          * call as part of cpu_init in slave cpu initialization.
484          */
485         sn_cpu_init();
486
487 #ifdef CONFIG_SMP
488         init_smp_config();
489 #endif
490         screen_info = sn_screen_info;
491
492         sn_timer_init();
493
494         /*
495          * set pm_power_off to a SAL call to allow
496          * sn machines to power off. The SAL call can be replaced
497          * by an ACPI interface call when ACPI is fully implemented
498          * for sn.
499          */
500         pm_power_off = ia64_sn_power_down;
501 }
502
503 /**
504  * sn_init_pdas - setup node data areas
505  *
506  * One time setup for Node Data Area.  Called by sn_setup().
507  */
508 static void __init sn_init_pdas(char **cmdline_p)
509 {
510         cnodeid_t cnode;
511
512         /*
513          * Allocate & initalize the nodepda for each node.
514          */
515         for_each_online_node(cnode) {
516                 nodepdaindr[cnode] =
517                     alloc_bootmem_node(NODE_DATA(cnode), sizeof(nodepda_t));
518                 memset(nodepdaindr[cnode], 0, sizeof(nodepda_t));
519                 memset(nodepdaindr[cnode]->phys_cpuid, -1,
520                     sizeof(nodepdaindr[cnode]->phys_cpuid));
521                 spin_lock_init(&nodepdaindr[cnode]->ptc_lock);
522         }
523
524         /*
525          * Allocate & initialize nodepda for TIOs.  For now, put them on node 0.
526          */
527         for (cnode = num_online_nodes(); cnode < num_cnodes; cnode++) {
528                 nodepdaindr[cnode] =
529                     alloc_bootmem_node(NODE_DATA(0), sizeof(nodepda_t));
530                 memset(nodepdaindr[cnode], 0, sizeof(nodepda_t));
531         }
532
533         /*
534          * Now copy the array of nodepda pointers to each nodepda.
535          */
536         for (cnode = 0; cnode < num_cnodes; cnode++)
537                 memcpy(nodepdaindr[cnode]->pernode_pdaindr, nodepdaindr,
538                        sizeof(nodepdaindr));
539
540         /*
541          * Set up IO related platform-dependent nodepda fields.
542          * The following routine actually sets up the hubinfo struct
543          * in nodepda.
544          */
545         for_each_online_node(cnode) {
546                 bte_init_node(nodepdaindr[cnode], cnode);
547         }
548
549         /*
550          * Initialize the per node hubdev.  This includes IO Nodes and
551          * headless/memless nodes.
552          */
553         for (cnode = 0; cnode < num_cnodes; cnode++) {
554                 hubdev_init_node(nodepdaindr[cnode], cnode);
555         }
556 }
557
558 /**
559  * sn_cpu_init - initialize per-cpu data areas
560  * @cpuid: cpuid of the caller
561  *
562  * Called during cpu initialization on each cpu as it starts.
563  * Currently, initializes the per-cpu data area for SNIA.
564  * Also sets up a few fields in the nodepda.  Also known as
565  * platform_cpu_init() by the ia64 machvec code.
566  */
567 void __init sn_cpu_init(void)
568 {
569         int cpuid;
570         int cpuphyid;
571         int nasid;
572         int subnode;
573         int slice;
574         int cnode;
575         int i;
576         static int wars_have_been_checked;
577
578         if (smp_processor_id() == 0 && IS_MEDUSA()) {
579                 if (ia64_sn_is_fake_prom())
580                         sn_prom_type = 2;
581                 else
582                         sn_prom_type = 1;
583                 printk(KERN_INFO "Running on medusa with %s PROM\n",
584                        (sn_prom_type == 1) ? "real" : "fake");
585         }
586
587         memset(pda, 0, sizeof(pda));
588         if (ia64_sn_get_sn_info(0, &sn_hub_info->shub2,
589                                 &sn_hub_info->nasid_bitmask,
590                                 &sn_hub_info->nasid_shift,
591                                 &sn_system_size, &sn_sharing_domain_size,
592                                 &sn_partition_id, &sn_coherency_id,
593                                 &sn_region_size))
594                 BUG();
595         sn_hub_info->as_shift = sn_hub_info->nasid_shift - 2;
596
597         /*
598          * The boot cpu makes this call again after platform initialization is
599          * complete.
600          */
601         if (nodepdaindr[0] == NULL)
602                 return;
603
604         for (i = 0; i < MAX_PROM_FEATURE_SETS; i++)
605                 if (ia64_sn_get_prom_feature_set(i, &sn_prom_features[i]) != 0)
606                         break;
607
608         cpuid = smp_processor_id();
609         cpuphyid = get_sapicid();
610
611         if (ia64_sn_get_sapic_info(cpuphyid, &nasid, &subnode, &slice))
612                 BUG();
613
614         for (i=0; i < MAX_NUMNODES; i++) {
615                 if (nodepdaindr[i]) {
616                         nodepdaindr[i]->phys_cpuid[cpuid].nasid = nasid;
617                         nodepdaindr[i]->phys_cpuid[cpuid].slice = slice;
618                         nodepdaindr[i]->phys_cpuid[cpuid].subnode = subnode;
619                 }
620         }
621
622         cnode = nasid_to_cnodeid(nasid);
623
624         sn_nodepda = nodepdaindr[cnode];
625
626         pda->led_address =
627             (typeof(pda->led_address)) (LED0 + (slice << LED_CPU_SHIFT));
628         pda->led_state = LED_ALWAYS_SET;
629         pda->hb_count = HZ / 2;
630         pda->hb_state = 0;
631         pda->idle_flag = 0;
632
633         if (cpuid != 0) {
634                 /* copy cpu 0's sn_cnodeid_to_nasid table to this cpu's */
635                 memcpy(sn_cnodeid_to_nasid,
636                        (&per_cpu(__sn_cnodeid_to_nasid, 0)),
637                        sizeof(__ia64_per_cpu_var(__sn_cnodeid_to_nasid)));
638         }
639
640         /*
641          * Check for WARs.
642          * Only needs to be done once, on BSP.
643          * Has to be done after loop above, because it uses this cpu's
644          * sn_cnodeid_to_nasid table which was just initialized if this
645          * isn't cpu 0.
646          * Has to be done before assignment below.
647          */
648         if (!wars_have_been_checked) {
649                 sn_check_for_wars();
650                 wars_have_been_checked = 1;
651         }
652         sn_hub_info->shub_1_1_found = shub_1_1_found;
653
654         /*
655          * Set up addresses of PIO/MEM write status registers.
656          */
657         {
658                 u64 pio1[] = {SH1_PIO_WRITE_STATUS_0, 0, SH1_PIO_WRITE_STATUS_1, 0};
659                 u64 pio2[] = {SH2_PIO_WRITE_STATUS_0, SH2_PIO_WRITE_STATUS_2,
660                         SH2_PIO_WRITE_STATUS_1, SH2_PIO_WRITE_STATUS_3};
661                 u64 *pio;
662                 pio = is_shub1() ? pio1 : pio2;
663                 pda->pio_write_status_addr = (volatile unsigned long *) LOCAL_MMR_ADDR(pio[slice]);
664                 pda->pio_write_status_val = is_shub1() ? SH_PIO_WRITE_STATUS_PENDING_WRITE_COUNT_MASK : 0;
665         }
666
667         /*
668          * WAR addresses for SHUB 1.x.
669          */
670         if (local_node_data->active_cpu_count++ == 0 && is_shub1()) {
671                 int buddy_nasid;
672                 buddy_nasid =
673                     cnodeid_to_nasid(numa_node_id() ==
674                                      num_online_nodes() - 1 ? 0 : numa_node_id() + 1);
675                 pda->pio_shub_war_cam_addr =
676                     (volatile unsigned long *)GLOBAL_MMR_ADDR(nasid,
677                                                               SH1_PI_CAM_CONTROL);
678         }
679 }
680
681 /*
682  * Build tables for converting between NASIDs and cnodes.
683  */
684 static inline int __init board_needs_cnode(int type)
685 {
686         return (type == KLTYPE_SNIA || type == KLTYPE_TIO);
687 }
688
689 void __init build_cnode_tables(void)
690 {
691         int nasid;
692         int node;
693         lboard_t *brd;
694
695         memset(physical_node_map, -1, sizeof(physical_node_map));
696         memset(sn_cnodeid_to_nasid, -1,
697                         sizeof(__ia64_per_cpu_var(__sn_cnodeid_to_nasid)));
698
699         /*
700          * First populate the tables with C/M bricks. This ensures that
701          * cnode == node for all C & M bricks.
702          */
703         for_each_online_node(node) {
704                 nasid = pxm_to_nasid(nid_to_pxm_map[node]);
705                 sn_cnodeid_to_nasid[node] = nasid;
706                 physical_node_map[nasid] = node;
707         }
708
709         /*
710          * num_cnodes is total number of C/M/TIO bricks. Because of the 256 node
711          * limit on the number of nodes, we can't use the generic node numbers 
712          * for this. Note that num_cnodes is incremented below as TIOs or
713          * headless/memoryless nodes are discovered.
714          */
715         num_cnodes = num_online_nodes();
716
717         /* fakeprom does not support klgraph */
718         if (IS_RUNNING_ON_FAKE_PROM())
719                 return;
720
721         /* Find TIOs & headless/memoryless nodes and add them to the tables */
722         for_each_online_node(node) {
723                 kl_config_hdr_t *klgraph_header;
724                 nasid = cnodeid_to_nasid(node);
725                 klgraph_header = ia64_sn_get_klconfig_addr(nasid);
726                 if (klgraph_header == NULL)
727                         BUG();
728                 brd = NODE_OFFSET_TO_LBOARD(nasid, klgraph_header->ch_board_info);
729                 while (brd) {
730                         if (board_needs_cnode(brd->brd_type) && physical_node_map[brd->brd_nasid] < 0) {
731                                 sn_cnodeid_to_nasid[num_cnodes] = brd->brd_nasid;
732                                 physical_node_map[brd->brd_nasid] = num_cnodes++;
733                         }
734                         brd = find_lboard_next(brd);
735                 }
736         }
737 }
738
739 int
740 nasid_slice_to_cpuid(int nasid, int slice)
741 {
742         long cpu;
743
744         for (cpu = 0; cpu < NR_CPUS; cpu++)
745                 if (cpuid_to_nasid(cpu) == nasid &&
746                                         cpuid_to_slice(cpu) == slice)
747                         return cpu;
748
749         return -1;
750 }
751
752 int sn_prom_feature_available(int id)
753 {
754         if (id >= BITS_PER_LONG * MAX_PROM_FEATURE_SETS)
755                 return 0;
756         return test_bit(id, sn_prom_features);
757 }
758 EXPORT_SYMBOL(sn_prom_feature_available);
759