2 * This file is subject to the terms and conditions of the GNU General
3 * Public License. See the file "COPYING" in the main directory of this
4 * archive for more details.
6 * Copyright (C) 2000 - 2001 by Kanoj Sarcar (kanoj@sgi.com)
7 * Copyright (C) 2000 - 2001 by Silicon Graphics, Inc.
9 #include <linux/init.h>
10 #include <linux/sched.h>
11 #include <linux/nodemask.h>
13 #include <asm/processor.h>
14 #include <asm/sn/arch.h>
15 #include <asm/sn/gda.h>
16 #include <asm/sn/intr.h>
17 #include <asm/sn/klconfig.h>
18 #include <asm/sn/launch.h>
19 #include <asm/sn/mapped_kernel.h>
20 #include <asm/sn/sn_private.h>
21 #include <asm/sn/types.h>
22 #include <asm/sn/sn0/hubpi.h>
23 #include <asm/sn/sn0/hubio.h>
24 #include <asm/sn/sn0/ip27.h>
27 * Takes as first input the PROM assigned cpu id, and the kernel
28 * assigned cpu id as the second.
30 static void alloc_cpupda(cpuid_t cpu
, int cpunum
)
32 cnodeid_t node
= get_cpu_cnode(cpu
);
33 nasid_t nasid
= COMPACT_TO_NASID_NODEID(node
);
35 cputonasid(cpunum
) = nasid
;
36 sn_cpu_info
[cpunum
].p_nodeid
= node
;
37 cputoslice(cpunum
) = get_cpu_slice(cpu
);
40 static nasid_t
get_actual_nasid(lboard_t
*brd
)
47 /* find out if we are a completely disabled brd. */
48 hub
= (klhub_t
*)find_first_component(brd
, KLSTRUCT_HUB
);
51 if (!(hub
->hub_info
.flags
& KLINFO_ENABLE
)) /* disabled node brd */
52 return hub
->hub_info
.physid
;
54 return brd
->brd_nasid
;
57 static int do_cpumask(cnodeid_t cnode
, nasid_t nasid
, int highest
)
59 static int tot_cpus_found
= 0;
65 brd
= find_lboard((lboard_t
*)KL_CONFIG_INFO(nasid
), KLTYPE_IP27
);
68 acpu
= (klcpu_t
*)find_first_component(brd
, KLSTRUCT_CPU
);
70 cpuid
= acpu
->cpu_info
.virtid
;
71 /* cnode is not valid for completely disabled brds */
72 if (get_actual_nasid(brd
) == brd
->brd_nasid
)
73 cpuid_to_compact_node
[cpuid
] = cnode
;
76 /* Only let it join in if it's marked enabled */
77 if ((acpu
->cpu_info
.flags
& KLINFO_ENABLE
) &&
78 (tot_cpus_found
!= NR_CPUS
)) {
79 set_cpu_possible(cpuid
, true);
80 alloc_cpupda(cpuid
, tot_cpus_found
);
84 acpu
= (klcpu_t
*)find_component(brd
, (klinfo_t
*)acpu
,
91 brd
= find_lboard(brd
, KLTYPE_IP27
);
97 void cpu_node_probe(void)
103 * Initialize the arrays to invalid nodeid (-1)
105 for (i
= 0; i
< MAX_COMPACT_NODES
; i
++)
106 compact_to_nasid_node
[i
] = INVALID_NASID
;
107 for (i
= 0; i
< MAX_NASIDS
; i
++)
108 nasid_to_compact_node
[i
] = INVALID_CNODEID
;
109 for (i
= 0; i
< MAXCPUS
; i
++)
110 cpuid_to_compact_node
[i
] = INVALID_CNODEID
;
113 * MCD - this whole "compact node" stuff can probably be dropped,
114 * as we can handle sparse numbering now
116 nodes_clear(node_online_map
);
117 for (i
= 0; i
< MAX_COMPACT_NODES
; i
++) {
118 nasid_t nasid
= gdap
->g_nasidtable
[i
];
119 if (nasid
== INVALID_NASID
)
121 compact_to_nasid_node
[i
] = nasid
;
122 nasid_to_compact_node
[nasid
] = i
;
123 node_set_online(num_online_nodes());
124 highest
= do_cpumask(i
, nasid
, highest
);
127 printk("Discovered %d cpus on %d nodes\n", highest
+ 1, num_online_nodes());
130 static __init
void intr_clear_all(nasid_t nasid
)
134 REMOTE_HUB_S(nasid
, PI_INT_MASK0_A
, 0);
135 REMOTE_HUB_S(nasid
, PI_INT_MASK0_B
, 0);
136 REMOTE_HUB_S(nasid
, PI_INT_MASK1_A
, 0);
137 REMOTE_HUB_S(nasid
, PI_INT_MASK1_B
, 0);
139 for (i
= 0; i
< 128; i
++)
140 REMOTE_HUB_CLR_INTR(nasid
, i
);
143 static void ip27_send_ipi_single(int destid
, unsigned int action
)
148 case SMP_RESCHEDULE_YOURSELF
:
149 irq
= CPU_RESCHED_A_IRQ
;
151 case SMP_CALL_FUNCTION
:
152 irq
= CPU_CALL_A_IRQ
;
158 irq
+= cputoslice(destid
);
161 * Convert the compact hub number to the NASID to get the correct
162 * part of the address space. Then set the interrupt bit associated
163 * with the CPU we want to send the interrupt to.
165 REMOTE_HUB_SEND_INTR(COMPACT_TO_NASID_NODEID(cpu_to_node(destid
)), irq
);
168 static void ip27_send_ipi_mask(const struct cpumask
*mask
, unsigned int action
)
172 for_each_cpu(i
, mask
)
173 ip27_send_ipi_single(i
, action
);
176 static void ip27_init_secondary(void)
181 static void ip27_smp_finish(void)
183 extern void hub_rt_clock_event_init(void);
185 hub_rt_clock_event_init();
190 * Launch a slave into smp_bootstrap(). It doesn't take an argument, and we
191 * set sp to the kernel stack of the newly created idle process, gp to the proc
192 * struct so that current_thread_info() will work.
194 static void ip27_boot_secondary(int cpu
, struct task_struct
*idle
)
196 unsigned long gp
= (unsigned long)task_thread_info(idle
);
197 unsigned long sp
= __KSTK_TOS(idle
);
199 LAUNCH_SLAVE(cputonasid(cpu
), cputoslice(cpu
),
200 (launch_proc_t
)MAPPED_KERN_RW_TO_K0(smp_bootstrap
),
201 0, (void *) sp
, (void *) gp
);
204 static void __init
ip27_smp_setup(void)
208 for_each_online_node(cnode
) {
211 intr_clear_all(COMPACT_TO_NASID_NODEID(cnode
));
214 replicate_kernel_text();
217 * Assumption to be fixed: we're always booted on logical / physical
218 * processor 0. While we're always running on logical processor 0
219 * this still means this is physical processor zero; it might for
220 * example be disabled in the firmware.
225 static void __init
ip27_prepare_cpus(unsigned int max_cpus
)
227 /* We already did everything necessary earlier */
230 struct plat_smp_ops ip27_smp_ops
= {
231 .send_ipi_single
= ip27_send_ipi_single
,
232 .send_ipi_mask
= ip27_send_ipi_mask
,
233 .init_secondary
= ip27_init_secondary
,
234 .smp_finish
= ip27_smp_finish
,
235 .boot_secondary
= ip27_boot_secondary
,
236 .smp_setup
= ip27_smp_setup
,
237 .prepare_cpus
= ip27_prepare_cpus
,