Loading...
1// SPDX-License-Identifier: GPL-2.0
2#include <linux/threads.h>
3#include <linux/cpumask.h>
4#include <linux/string.h>
5#include <linux/kernel.h>
6#include <linux/ctype.h>
7#include <linux/dmar.h>
8
9#include <asm/smp.h>
10#include <asm/ipi.h>
11#include "x2apic.h"
12
13int x2apic_phys;
14
15static struct apic apic_x2apic_phys;
16
17static int __init set_x2apic_phys_mode(char *arg)
18{
19 x2apic_phys = 1;
20 return 0;
21}
22early_param("x2apic_phys", set_x2apic_phys_mode);
23
24static bool x2apic_fadt_phys(void)
25{
26#ifdef CONFIG_ACPI
27 if ((acpi_gbl_FADT.header.revision >= FADT2_REVISION_ID) &&
28 (acpi_gbl_FADT.flags & ACPI_FADT_APIC_PHYSICAL)) {
29 printk(KERN_DEBUG "System requires x2apic physical mode\n");
30 return true;
31 }
32#endif
33 return false;
34}
35
36static int x2apic_acpi_madt_oem_check(char *oem_id, char *oem_table_id)
37{
38 return x2apic_enabled() && (x2apic_phys || x2apic_fadt_phys());
39}
40
41static void x2apic_send_IPI(int cpu, int vector)
42{
43 u32 dest = per_cpu(x86_cpu_to_apicid, cpu);
44
45 x2apic_wrmsr_fence();
46 __x2apic_send_IPI_dest(dest, vector, APIC_DEST_PHYSICAL);
47}
48
49static void
50__x2apic_send_IPI_mask(const struct cpumask *mask, int vector, int apic_dest)
51{
52 unsigned long query_cpu;
53 unsigned long this_cpu;
54 unsigned long flags;
55
56 x2apic_wrmsr_fence();
57
58 local_irq_save(flags);
59
60 this_cpu = smp_processor_id();
61 for_each_cpu(query_cpu, mask) {
62 if (apic_dest == APIC_DEST_ALLBUT && this_cpu == query_cpu)
63 continue;
64 __x2apic_send_IPI_dest(per_cpu(x86_cpu_to_apicid, query_cpu),
65 vector, APIC_DEST_PHYSICAL);
66 }
67 local_irq_restore(flags);
68}
69
70static void x2apic_send_IPI_mask(const struct cpumask *mask, int vector)
71{
72 __x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLINC);
73}
74
75static void
76 x2apic_send_IPI_mask_allbutself(const struct cpumask *mask, int vector)
77{
78 __x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLBUT);
79}
80
81static void x2apic_send_IPI_allbutself(int vector)
82{
83 __x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLBUT);
84}
85
86static void x2apic_send_IPI_all(int vector)
87{
88 __x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLINC);
89}
90
91static void init_x2apic_ldr(void)
92{
93}
94
95static int x2apic_phys_probe(void)
96{
97 if (x2apic_mode && (x2apic_phys || x2apic_fadt_phys()))
98 return 1;
99
100 return apic == &apic_x2apic_phys;
101}
102
103/* Common x2apic functions, also used by x2apic_cluster */
104int x2apic_apic_id_valid(u32 apicid)
105{
106 return 1;
107}
108
109int x2apic_apic_id_registered(void)
110{
111 return 1;
112}
113
114void __x2apic_send_IPI_dest(unsigned int apicid, int vector, unsigned int dest)
115{
116 unsigned long cfg = __prepare_ICR(0, vector, dest);
117 native_x2apic_icr_write(cfg, apicid);
118}
119
120unsigned int x2apic_get_apic_id(unsigned long id)
121{
122 return id;
123}
124
125u32 x2apic_set_apic_id(unsigned int id)
126{
127 return id;
128}
129
130int x2apic_phys_pkg_id(int initial_apicid, int index_msb)
131{
132 return initial_apicid >> index_msb;
133}
134
135void x2apic_send_IPI_self(int vector)
136{
137 apic_write(APIC_SELF_IPI, vector);
138}
139
140static struct apic apic_x2apic_phys __ro_after_init = {
141
142 .name = "physical x2apic",
143 .probe = x2apic_phys_probe,
144 .acpi_madt_oem_check = x2apic_acpi_madt_oem_check,
145 .apic_id_valid = x2apic_apic_id_valid,
146 .apic_id_registered = x2apic_apic_id_registered,
147
148 .irq_delivery_mode = dest_Fixed,
149 .irq_dest_mode = 0, /* physical */
150
151 .disable_esr = 0,
152 .dest_logical = 0,
153 .check_apicid_used = NULL,
154
155 .init_apic_ldr = init_x2apic_ldr,
156
157 .ioapic_phys_id_map = NULL,
158 .setup_apic_routing = NULL,
159 .cpu_present_to_apicid = default_cpu_present_to_apicid,
160 .apicid_to_cpu_present = NULL,
161 .check_phys_apicid_present = default_check_phys_apicid_present,
162 .phys_pkg_id = x2apic_phys_pkg_id,
163
164 .get_apic_id = x2apic_get_apic_id,
165 .set_apic_id = x2apic_set_apic_id,
166
167 .calc_dest_apicid = apic_default_calc_apicid,
168
169 .send_IPI = x2apic_send_IPI,
170 .send_IPI_mask = x2apic_send_IPI_mask,
171 .send_IPI_mask_allbutself = x2apic_send_IPI_mask_allbutself,
172 .send_IPI_allbutself = x2apic_send_IPI_allbutself,
173 .send_IPI_all = x2apic_send_IPI_all,
174 .send_IPI_self = x2apic_send_IPI_self,
175
176 .inquire_remote_apic = NULL,
177
178 .read = native_apic_msr_read,
179 .write = native_apic_msr_write,
180 .eoi_write = native_apic_msr_eoi_write,
181 .icr_read = native_x2apic_icr_read,
182 .icr_write = native_x2apic_icr_write,
183 .wait_icr_idle = native_x2apic_wait_icr_idle,
184 .safe_wait_icr_idle = native_safe_x2apic_wait_icr_idle,
185};
186
187apic_driver(apic_x2apic_phys);
1#include <linux/threads.h>
2#include <linux/cpumask.h>
3#include <linux/string.h>
4#include <linux/kernel.h>
5#include <linux/ctype.h>
6#include <linux/init.h>
7#include <linux/dmar.h>
8
9#include <asm/smp.h>
10#include <asm/x2apic.h>
11
12int x2apic_phys;
13
14static struct apic apic_x2apic_phys;
15
16static int set_x2apic_phys_mode(char *arg)
17{
18 x2apic_phys = 1;
19 return 0;
20}
21early_param("x2apic_phys", set_x2apic_phys_mode);
22
23static int x2apic_acpi_madt_oem_check(char *oem_id, char *oem_table_id)
24{
25 if (x2apic_phys)
26 return x2apic_enabled();
27 else
28 return 0;
29}
30
31static void
32__x2apic_send_IPI_mask(const struct cpumask *mask, int vector, int apic_dest)
33{
34 unsigned long query_cpu;
35 unsigned long this_cpu;
36 unsigned long flags;
37
38 x2apic_wrmsr_fence();
39
40 local_irq_save(flags);
41
42 this_cpu = smp_processor_id();
43 for_each_cpu(query_cpu, mask) {
44 if (apic_dest == APIC_DEST_ALLBUT && this_cpu == query_cpu)
45 continue;
46 __x2apic_send_IPI_dest(per_cpu(x86_cpu_to_apicid, query_cpu),
47 vector, APIC_DEST_PHYSICAL);
48 }
49 local_irq_restore(flags);
50}
51
52static void x2apic_send_IPI_mask(const struct cpumask *mask, int vector)
53{
54 __x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLINC);
55}
56
57static void
58 x2apic_send_IPI_mask_allbutself(const struct cpumask *mask, int vector)
59{
60 __x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLBUT);
61}
62
63static void x2apic_send_IPI_allbutself(int vector)
64{
65 __x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLBUT);
66}
67
68static void x2apic_send_IPI_all(int vector)
69{
70 __x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLINC);
71}
72
73static unsigned int x2apic_cpu_mask_to_apicid(const struct cpumask *cpumask)
74{
75 /*
76 * We're using fixed IRQ delivery, can only return one phys APIC ID.
77 * May as well be the first.
78 */
79 int cpu = cpumask_first(cpumask);
80
81 if ((unsigned)cpu < nr_cpu_ids)
82 return per_cpu(x86_cpu_to_apicid, cpu);
83 else
84 return BAD_APICID;
85}
86
87static unsigned int
88x2apic_cpu_mask_to_apicid_and(const struct cpumask *cpumask,
89 const struct cpumask *andmask)
90{
91 int cpu;
92
93 /*
94 * We're using fixed IRQ delivery, can only return one phys APIC ID.
95 * May as well be the first.
96 */
97 for_each_cpu_and(cpu, cpumask, andmask) {
98 if (cpumask_test_cpu(cpu, cpu_online_mask))
99 break;
100 }
101
102 return per_cpu(x86_cpu_to_apicid, cpu);
103}
104
105static void init_x2apic_ldr(void)
106{
107}
108
109static int x2apic_phys_probe(void)
110{
111 if (x2apic_mode && x2apic_phys)
112 return 1;
113
114 return apic == &apic_x2apic_phys;
115}
116
117static struct apic apic_x2apic_phys = {
118
119 .name = "physical x2apic",
120 .probe = x2apic_phys_probe,
121 .acpi_madt_oem_check = x2apic_acpi_madt_oem_check,
122 .apic_id_registered = x2apic_apic_id_registered,
123
124 .irq_delivery_mode = dest_Fixed,
125 .irq_dest_mode = 0, /* physical */
126
127 .target_cpus = x2apic_target_cpus,
128 .disable_esr = 0,
129 .dest_logical = 0,
130 .check_apicid_used = NULL,
131 .check_apicid_present = NULL,
132
133 .vector_allocation_domain = x2apic_vector_allocation_domain,
134 .init_apic_ldr = init_x2apic_ldr,
135
136 .ioapic_phys_id_map = NULL,
137 .setup_apic_routing = NULL,
138 .multi_timer_check = NULL,
139 .cpu_present_to_apicid = default_cpu_present_to_apicid,
140 .apicid_to_cpu_present = NULL,
141 .setup_portio_remap = NULL,
142 .check_phys_apicid_present = default_check_phys_apicid_present,
143 .enable_apic_mode = NULL,
144 .phys_pkg_id = x2apic_phys_pkg_id,
145 .mps_oem_check = NULL,
146
147 .get_apic_id = x2apic_get_apic_id,
148 .set_apic_id = x2apic_set_apic_id,
149 .apic_id_mask = 0xFFFFFFFFu,
150
151 .cpu_mask_to_apicid = x2apic_cpu_mask_to_apicid,
152 .cpu_mask_to_apicid_and = x2apic_cpu_mask_to_apicid_and,
153
154 .send_IPI_mask = x2apic_send_IPI_mask,
155 .send_IPI_mask_allbutself = x2apic_send_IPI_mask_allbutself,
156 .send_IPI_allbutself = x2apic_send_IPI_allbutself,
157 .send_IPI_all = x2apic_send_IPI_all,
158 .send_IPI_self = x2apic_send_IPI_self,
159
160 .trampoline_phys_low = DEFAULT_TRAMPOLINE_PHYS_LOW,
161 .trampoline_phys_high = DEFAULT_TRAMPOLINE_PHYS_HIGH,
162 .wait_for_init_deassert = NULL,
163 .smp_callin_clear_local_apic = NULL,
164 .inquire_remote_apic = NULL,
165
166 .read = native_apic_msr_read,
167 .write = native_apic_msr_write,
168 .icr_read = native_x2apic_icr_read,
169 .icr_write = native_x2apic_icr_write,
170 .wait_icr_idle = native_x2apic_wait_icr_idle,
171 .safe_wait_icr_idle = native_safe_x2apic_wait_icr_idle,
172};
173
174apic_driver(apic_x2apic_phys);