Commit | Line | Data |
---|---|---|
41c594ab RB |
1 | /* |
2 | * Malta Platform-specific hooks for SMP operation | |
3 | */ | |
45a98eb2 | 4 | #include <linux/irq.h> |
57a2050c | 5 | #include <linux/init.h> |
41c594ab | 6 | |
57a2050c RB |
7 | #include <asm/mipsregs.h> |
8 | #include <asm/mipsmtregs.h> | |
9 | #include <asm/smtc.h> | |
41c594ab | 10 | #include <asm/smtc_ipi.h> |
41c594ab RB |
11 | |
12 | /* VPE/SMP Prototype implements platform interfaces directly */ | |
41c594ab RB |
13 | |
14 | /* | |
15 | * Cause the specified action to be performed on a targeted "CPU" | |
16 | */ | |
17 | ||
87353d8a | 18 | static void msmtc_send_ipi_single(int cpu, unsigned int action) |
41c594ab | 19 | { |
57a2050c | 20 | /* "CPU" may be TC of same VPE, VPE of same CPU, or different CPU */ |
41c594ab | 21 | smtc_send_ipi(cpu, LINUX_SMP_IPI, action); |
41c594ab RB |
22 | } |
23 | ||
48a048fe | 24 | static void msmtc_send_ipi_mask(const struct cpumask *mask, unsigned int action) |
41c594ab | 25 | { |
87353d8a RB |
26 | unsigned int i; |
27 | ||
48a048fe | 28 | for_each_cpu(i, mask) |
87353d8a | 29 | msmtc_send_ipi_single(i, action); |
41c594ab RB |
30 | } |
31 | ||
32 | /* | |
33 | * Post-config but pre-boot cleanup entry point | |
34 | */ | |
87353d8a | 35 | static void __cpuinit msmtc_init_secondary(void) |
41c594ab | 36 | { |
41c594ab RB |
37 | int myvpe; |
38 | ||
39 | /* Don't enable Malta I/O interrupts (IP2) for secondary VPEs */ | |
40 | myvpe = read_c0_tcbind() & TCBIND_CURVPE; | |
41 | if (myvpe != 0) { | |
42 | /* Ideally, this should be done only once per VPE, but... */ | |
dc0366bf RB |
43 | clear_c0_status(ST0_IM); |
44 | set_c0_status((0x100 << cp0_compare_irq) | |
45 | | (0x100 << MIPS_CPU_IPI_IRQ)); | |
46 | if (cp0_perfcount_irq >= 0) | |
47 | set_c0_status(0x100 << cp0_perfcount_irq); | |
41c594ab RB |
48 | } |
49 | ||
87353d8a | 50 | smtc_init_secondary(); |
41c594ab RB |
51 | } |
52 | ||
53 | /* | |
87353d8a | 54 | * Platform "CPU" startup hook |
41c594ab | 55 | */ |
87353d8a | 56 | static void __cpuinit msmtc_boot_secondary(int cpu, struct task_struct *idle) |
41c594ab | 57 | { |
87353d8a | 58 | smtc_boot_secondary(cpu, idle); |
41c594ab RB |
59 | } |
60 | ||
87353d8a RB |
61 | /* |
62 | * SMP initialization finalization entry point | |
63 | */ | |
64 | static void __cpuinit msmtc_smp_finish(void) | |
41c594ab | 65 | { |
87353d8a | 66 | smtc_smp_finish(); |
41c594ab RB |
67 | } |
68 | ||
69 | /* | |
87353d8a | 70 | * Hook for after all CPUs are online |
41c594ab RB |
71 | */ |
72 | ||
87353d8a | 73 | static void msmtc_cpus_done(void) |
41c594ab | 74 | { |
41c594ab RB |
75 | } |
76 | ||
77 | /* | |
87353d8a RB |
78 | * Platform SMP pre-initialization |
79 | * | |
80 | * As noted above, we can assume a single CPU for now | |
81 | * but it may be multithreaded. | |
41c594ab RB |
82 | */ |
83 | ||
87353d8a | 84 | static void __init msmtc_smp_setup(void) |
41c594ab | 85 | { |
8531a35e KK |
86 | /* |
87 | * we won't get the definitive value until | |
88 | * we've run smtc_prepare_cpus later, but | |
89 | * we would appear to need an upper bound now. | |
90 | */ | |
91 | smp_num_siblings = smtc_build_cpu_map(0); | |
41c594ab | 92 | } |
f571eff0 | 93 | |
87353d8a RB |
94 | static void __init msmtc_prepare_cpus(unsigned int max_cpus) |
95 | { | |
8531a35e | 96 | smtc_prepare_cpus(max_cpus); |
87353d8a RB |
97 | } |
98 | ||
99 | struct plat_smp_ops msmtc_smp_ops = { | |
100 | .send_ipi_single = msmtc_send_ipi_single, | |
101 | .send_ipi_mask = msmtc_send_ipi_mask, | |
102 | .init_secondary = msmtc_init_secondary, | |
103 | .smp_finish = msmtc_smp_finish, | |
104 | .cpus_done = msmtc_cpus_done, | |
105 | .boot_secondary = msmtc_boot_secondary, | |
106 | .smp_setup = msmtc_smp_setup, | |
107 | .prepare_cpus = msmtc_prepare_cpus, | |
108 | }; | |
109 | ||
f571eff0 KK |
110 | #ifdef CONFIG_MIPS_MT_SMTC_IRQAFF |
111 | /* | |
112 | * IRQ affinity hook | |
113 | */ | |
114 | ||
115 | ||
7c8d948f TG |
116 | int plat_set_irq_affinity(struct irq_data *d, const struct cpumask *affinity, |
117 | bool force) | |
f571eff0 | 118 | { |
e65e49d0 | 119 | cpumask_t tmask; |
f571eff0 KK |
120 | int cpu = 0; |
121 | void smtc_set_irq_affinity(unsigned int irq, cpumask_t aff); | |
122 | ||
123 | /* | |
124 | * On the legacy Malta development board, all I/O interrupts | |
125 | * are routed through the 8259 and combined in a single signal | |
126 | * to the CPU daughterboard, and on the CoreFPGA2/3 34K models, | |
127 | * that signal is brought to IP2 of both VPEs. To avoid racing | |
128 | * concurrent interrupt service events, IP2 is enabled only on | |
129 | * one VPE, by convention VPE0. So long as no bits are ever | |
130 | * cleared in the affinity mask, there will never be any | |
131 | * interrupt forwarding. But as soon as a program or operator | |
132 | * sets affinity for one of the related IRQs, we need to make | |
25985edc | 133 | * sure that we don't ever try to forward across the VPE boundary, |
f571eff0 KK |
134 | * at least not until we engineer a system where the interrupt |
135 | * _ack() or _end() function can somehow know that it corresponds | |
136 | * to an interrupt taken on another VPE, and perform the appropriate | |
137 | * restoration of Status.IM state using MFTR/MTTR instead of the | |
138 | * normal local behavior. We also ensure that no attempt will | |
139 | * be made to forward to an offline "CPU". | |
140 | */ | |
141 | ||
e65e49d0 | 142 | cpumask_copy(&tmask, affinity); |
0de26520 | 143 | for_each_cpu(cpu, affinity) { |
f571eff0 KK |
144 | if ((cpu_data[cpu].vpe_id != 0) || !cpu_online(cpu)) |
145 | cpu_clear(cpu, tmask); | |
146 | } | |
7c8d948f | 147 | cpumask_copy(d->affinity, &tmask); |
f571eff0 KK |
148 | |
149 | if (cpus_empty(tmask)) | |
150 | /* | |
151 | * We could restore a default mask here, but the | |
152 | * runtime code can anyway deal with the null set | |
153 | */ | |
154 | printk(KERN_WARNING | |
34ed9506 | 155 | "IRQ affinity leaves no legal CPU for IRQ %d\n", d->irq); |
f571eff0 KK |
156 | |
157 | /* Do any generic SMTC IRQ affinity setup */ | |
7c8d948f | 158 | smtc_set_irq_affinity(d->irq, tmask); |
d5dedd45 | 159 | |
7c8d948f | 160 | return IRQ_SET_MASK_OK_NOCOPY; |
f571eff0 KK |
161 | } |
162 | #endif /* CONFIG_MIPS_MT_SMTC_IRQAFF */ |