arch/x86/kernel/apic/x2apic_phys.c

   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_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
 174 apic_driver(apic_x2apic_phys);