Linux Audio

Check our new training course

Loading...
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);
v4.6
  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/dmar.h>
  7
  8#include <asm/smp.h>
  9#include <asm/x2apic.h>
 10
 11int x2apic_phys;
 12
 13static struct apic apic_x2apic_phys;
 14
 15static int set_x2apic_phys_mode(char *arg)
 16{
 17	x2apic_phys = 1;
 18	return 0;
 19}
 20early_param("x2apic_phys", set_x2apic_phys_mode);
 21
 22static bool x2apic_fadt_phys(void)
 23{
 24#ifdef CONFIG_ACPI
 25	if ((acpi_gbl_FADT.header.revision >= FADT2_REVISION_ID) &&
 26		(acpi_gbl_FADT.flags & ACPI_FADT_APIC_PHYSICAL)) {
 27		printk(KERN_DEBUG "System requires x2apic physical mode\n");
 28		return true;
 29	}
 30#endif
 31	return false;
 32}
 33
 34static int x2apic_acpi_madt_oem_check(char *oem_id, char *oem_table_id)
 35{
 36	return x2apic_enabled() && (x2apic_phys || x2apic_fadt_phys());
 37}
 38
 39static void x2apic_send_IPI(int cpu, int vector)
 40{
 41	u32 dest = per_cpu(x86_cpu_to_apicid, cpu);
 42
 43	x2apic_wrmsr_fence();
 44	__x2apic_send_IPI_dest(dest, vector, APIC_DEST_PHYSICAL);
 45}
 46
 47static void
 48__x2apic_send_IPI_mask(const struct cpumask *mask, int vector, int apic_dest)
 49{
 50	unsigned long query_cpu;
 51	unsigned long this_cpu;
 52	unsigned long flags;
 53
 54	x2apic_wrmsr_fence();
 55
 56	local_irq_save(flags);
 57
 58	this_cpu = smp_processor_id();
 59	for_each_cpu(query_cpu, mask) {
 60		if (apic_dest == APIC_DEST_ALLBUT && this_cpu == query_cpu)
 61			continue;
 62		__x2apic_send_IPI_dest(per_cpu(x86_cpu_to_apicid, query_cpu),
 63				       vector, APIC_DEST_PHYSICAL);
 64	}
 65	local_irq_restore(flags);
 66}
 67
 68static void x2apic_send_IPI_mask(const struct cpumask *mask, int vector)
 69{
 70	__x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLINC);
 71}
 72
 73static void
 74 x2apic_send_IPI_mask_allbutself(const struct cpumask *mask, int vector)
 75{
 76	__x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLBUT);
 77}
 78
 79static void x2apic_send_IPI_allbutself(int vector)
 80{
 81	__x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLBUT);
 82}
 83
 84static void x2apic_send_IPI_all(int vector)
 85{
 86	__x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLINC);
 87}
 88
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 89static void init_x2apic_ldr(void)
 90{
 91}
 92
 93static int x2apic_phys_probe(void)
 94{
 95	if (x2apic_mode && (x2apic_phys || x2apic_fadt_phys()))
 96		return 1;
 97
 98	return apic == &apic_x2apic_phys;
 99}
100
101static struct apic apic_x2apic_phys = {
102
103	.name				= "physical x2apic",
104	.probe				= x2apic_phys_probe,
105	.acpi_madt_oem_check		= x2apic_acpi_madt_oem_check,
106	.apic_id_valid			= x2apic_apic_id_valid,
107	.apic_id_registered		= x2apic_apic_id_registered,
108
109	.irq_delivery_mode		= dest_Fixed,
110	.irq_dest_mode			= 0, /* physical */
111
112	.target_cpus			= online_target_cpus,
113	.disable_esr			= 0,
114	.dest_logical			= 0,
115	.check_apicid_used		= NULL,
 
116
117	.vector_allocation_domain	= default_vector_allocation_domain,
118	.init_apic_ldr			= init_x2apic_ldr,
119
120	.ioapic_phys_id_map		= NULL,
121	.setup_apic_routing		= NULL,
 
122	.cpu_present_to_apicid		= default_cpu_present_to_apicid,
123	.apicid_to_cpu_present		= NULL,
 
124	.check_phys_apicid_present	= default_check_phys_apicid_present,
 
125	.phys_pkg_id			= x2apic_phys_pkg_id,
 
126
127	.get_apic_id			= x2apic_get_apic_id,
128	.set_apic_id			= x2apic_set_apic_id,
129	.apic_id_mask			= 0xFFFFFFFFu,
130
131	.cpu_mask_to_apicid_and		= default_cpu_mask_to_apicid_and,
 
132
133	.send_IPI			= x2apic_send_IPI,
134	.send_IPI_mask			= x2apic_send_IPI_mask,
135	.send_IPI_mask_allbutself	= x2apic_send_IPI_mask_allbutself,
136	.send_IPI_allbutself		= x2apic_send_IPI_allbutself,
137	.send_IPI_all			= x2apic_send_IPI_all,
138	.send_IPI_self			= x2apic_send_IPI_self,
139
 
 
 
 
140	.inquire_remote_apic		= NULL,
141
142	.read				= native_apic_msr_read,
143	.write				= native_apic_msr_write,
144	.eoi_write			= native_apic_msr_eoi_write,
145	.icr_read			= native_x2apic_icr_read,
146	.icr_write			= native_x2apic_icr_write,
147	.wait_icr_idle			= native_x2apic_wait_icr_idle,
148	.safe_wait_icr_idle		= native_safe_x2apic_wait_icr_idle,
149};
150
151apic_driver(apic_x2apic_phys);