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 12 int x2apic_phys; 13 14 static struct apic apic_x2apic_phys; 15 16 static int set_x2apic_phys_mode(char *arg) 17 { 18 x2apic_phys = 1; 19 return 0; 20 } 21 early_param("x2apic_phys", set_x2apic_phys_mode); 22 23 static 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 31 static 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 52 static void x2apic_send_IPI_mask(const struct cpumask *mask, int vector) 53 { 54 __x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLINC); 55 } 56 57 static 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 63 static void x2apic_send_IPI_allbutself(int vector) 64 { 65 __x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLBUT); 66 } 67 68 static void x2apic_send_IPI_all(int vector) 69 { 70 __x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLINC); 71 } 72 73 static 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 87 static unsigned int 88 x2apic_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 105 static void init_x2apic_ldr(void) 106 { 107 } 108 109 static int x2apic_phys_probe(void) 110 { 111 if (x2apic_mode && x2apic_phys) 112 return 1; 113 114 return apic == &apic_x2apic_phys; 115 } 116 117 static 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_valid = x2apic_apic_id_valid, 123 .apic_id_registered = x2apic_apic_id_registered, 124 125 .irq_delivery_mode = dest_Fixed, 126 .irq_dest_mode = 0, /* physical */ 127 128 .target_cpus = x2apic_target_cpus, 129 .disable_esr = 0, 130 .dest_logical = 0, 131 .check_apicid_used = NULL, 132 .check_apicid_present = NULL, 133 134 .vector_allocation_domain = x2apic_vector_allocation_domain, 135 .init_apic_ldr = init_x2apic_ldr, 136 137 .ioapic_phys_id_map = NULL, 138 .setup_apic_routing = NULL, 139 .multi_timer_check = NULL, 140 .cpu_present_to_apicid = default_cpu_present_to_apicid, 141 .apicid_to_cpu_present = NULL, 142 .setup_portio_remap = NULL, 143 .check_phys_apicid_present = default_check_phys_apicid_present, 144 .enable_apic_mode = NULL, 145 .phys_pkg_id = x2apic_phys_pkg_id, 146 .mps_oem_check = NULL, 147 148 .get_apic_id = x2apic_get_apic_id, 149 .set_apic_id = x2apic_set_apic_id, 150 .apic_id_mask = 0xFFFFFFFFu, 151 152 .cpu_mask_to_apicid = x2apic_cpu_mask_to_apicid, 153 .cpu_mask_to_apicid_and = x2apic_cpu_mask_to_apicid_and, 154 155 .send_IPI_mask = x2apic_send_IPI_mask, 156 .send_IPI_mask_allbutself = x2apic_send_IPI_mask_allbutself, 157 .send_IPI_allbutself = x2apic_send_IPI_allbutself, 158 .send_IPI_all = x2apic_send_IPI_all, 159 .send_IPI_self = x2apic_send_IPI_self, 160 161 .trampoline_phys_low = DEFAULT_TRAMPOLINE_PHYS_LOW, 162 .trampoline_phys_high = DEFAULT_TRAMPOLINE_PHYS_HIGH, 163 .wait_for_init_deassert = NULL, 164 .smp_callin_clear_local_apic = NULL, 165 .inquire_remote_apic = NULL, 166 167 .read = native_apic_msr_read, 168 .write = native_apic_msr_write, 169 .icr_read = native_x2apic_icr_read, 170 .icr_write = native_x2apic_icr_write, 171 .wait_icr_idle = native_x2apic_wait_icr_idle, 172 .safe_wait_icr_idle = native_safe_x2apic_wait_icr_idle, 173 }; 174 175 apic_driver(apic_x2apic_phys); 176