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 bool x2apic_fadt_phys(void)
  24 {
  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         return false;
  31 }
  32
  33 static int x2apic_acpi_madt_oem_check(char *oem_id, char *oem_table_id)
  34 {
  35         return x2apic_enabled() && (x2apic_phys || x2apic_fadt_phys());
  36 }
  37
  38 static void
  39 __x2apic_send_IPI_mask(const struct cpumask *mask, int vector, int apic_dest)
  40 {
  41         unsigned long query_cpu;
  42         unsigned long this_cpu;
  43         unsigned long flags;
  44
  45         x2apic_wrmsr_fence();
  46
  47         local_irq_save(flags);
  48
  49         this_cpu = smp_processor_id();
  50         for_each_cpu(query_cpu, mask) {
  51                 if (apic_dest == APIC_DEST_ALLBUT && this_cpu == query_cpu)
  52                         continue;
  53                 __x2apic_send_IPI_dest(per_cpu(x86_cpu_to_apicid, query_cpu),
  54                                        vector, APIC_DEST_PHYSICAL);
  55         }
  56         local_irq_restore(flags);
  57 }
  58
  59 static void x2apic_send_IPI_mask(const struct cpumask *mask, int vector)
  60 {
  61         __x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLINC);
  62 }
  63
  64 static void
  65  x2apic_send_IPI_mask_allbutself(const struct cpumask *mask, int vector)
  66 {
  67         __x2apic_send_IPI_mask(mask, vector, APIC_DEST_ALLBUT);
  68 }
  69
  70 static void x2apic_send_IPI_allbutself(int vector)
  71 {
  72         __x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLBUT);
  73 }
  74
  75 static void x2apic_send_IPI_all(int vector)
  76 {
  77         __x2apic_send_IPI_mask(cpu_online_mask, vector, APIC_DEST_ALLINC);
  78 }
  79
  80 static unsigned int x2apic_cpu_mask_to_apicid(const struct cpumask *cpumask)
  81 {
  82         /*
  83          * We're using fixed IRQ delivery, can only return one phys APIC ID.
  84          * May as well be the first.
  85          */
  86         int cpu = cpumask_first(cpumask);
  87
  88         if ((unsigned)cpu < nr_cpu_ids)
  89                 return per_cpu(x86_cpu_to_apicid, cpu);
  90         else
  91                 return BAD_APICID;
  92 }
  93
  94 static unsigned int
  95 x2apic_cpu_mask_to_apicid_and(const struct cpumask *cpumask,
  96                               const struct cpumask *andmask)
  97 {
  98         int cpu;
  99
 100         /*
 101          * We're using fixed IRQ delivery, can only return one phys APIC ID.
 102          * May as well be the first.
 103          */
 104         for_each_cpu_and(cpu, cpumask, andmask) {
 105                 if (cpumask_test_cpu(cpu, cpu_online_mask))
 106                         break;
 107         }
 108
 109         return per_cpu(x86_cpu_to_apicid, cpu);
 110 }
 111
 112 static void init_x2apic_ldr(void)
 113 {
 114 }
 115
 116 static int x2apic_phys_probe(void)
 117 {
 118         if (x2apic_mode && (x2apic_phys || x2apic_fadt_phys()))
 119                 return 1;
 120
 121         return apic == &apic_x2apic_phys;
 122 }
 123
 124 static struct apic apic_x2apic_phys = {
 125
 126         .name                           = "physical x2apic",
 127         .probe                          = x2apic_phys_probe,
 128         .acpi_madt_oem_check            = x2apic_acpi_madt_oem_check,
 129         .apic_id_registered             = x2apic_apic_id_registered,
 130
 131         .irq_delivery_mode              = dest_Fixed,
 132         .irq_dest_mode                  = 0, /* physical */
 133
 134         .target_cpus                    = x2apic_target_cpus,
 135         .disable_esr                    = 0,
 136         .dest_logical                   = 0,
 137         .check_apicid_used              = NULL,
 138         .check_apicid_present           = NULL,
 139
 140         .vector_allocation_domain       = x2apic_vector_allocation_domain,
 141         .init_apic_ldr                  = init_x2apic_ldr,
 142
 143         .ioapic_phys_id_map             = NULL,
 144         .setup_apic_routing             = NULL,
 145         .multi_timer_check              = NULL,
 146         .cpu_present_to_apicid          = default_cpu_present_to_apicid,
 147         .apicid_to_cpu_present          = NULL,
 148         .setup_portio_remap             = NULL,
 149         .check_phys_apicid_present      = default_check_phys_apicid_present,
 150         .enable_apic_mode               = NULL,
 151         .phys_pkg_id                    = x2apic_phys_pkg_id,
 152         .mps_oem_check                  = NULL,
 153
 154         .get_apic_id                    = x2apic_get_apic_id,
 155         .set_apic_id                    = x2apic_set_apic_id,
 156         .apic_id_mask                   = 0xFFFFFFFFu,
 157
 158         .cpu_mask_to_apicid             = x2apic_cpu_mask_to_apicid,
 159         .cpu_mask_to_apicid_and         = x2apic_cpu_mask_to_apicid_and,
 160
 161         .send_IPI_mask                  = x2apic_send_IPI_mask,
 162         .send_IPI_mask_allbutself       = x2apic_send_IPI_mask_allbutself,
 163         .send_IPI_allbutself            = x2apic_send_IPI_allbutself,
 164         .send_IPI_all                   = x2apic_send_IPI_all,
 165         .send_IPI_self                  = x2apic_send_IPI_self,
 166
 167         .trampoline_phys_low            = DEFAULT_TRAMPOLINE_PHYS_LOW,
 168         .trampoline_phys_high           = DEFAULT_TRAMPOLINE_PHYS_HIGH,
 169         .wait_for_init_deassert         = NULL,
 170         .smp_callin_clear_local_apic    = NULL,
 171         .inquire_remote_apic            = NULL,
 172
 173         .read                           = native_apic_msr_read,
 174         .write                          = native_apic_msr_write,
 175         .icr_read                       = native_x2apic_icr_read,
 176         .icr_write                      = native_x2apic_icr_write,
 177         .wait_icr_idle                  = native_x2apic_wait_icr_idle,
 178         .safe_wait_icr_idle             = native_safe_x2apic_wait_icr_idle,
 179 };
 180
 181 apic_driver(apic_x2apic_phys);