Linux Audio

Check our new training course

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