1 /* 2 * Xen SMP support 3 * 4 * This file implements the Xen versions of smp_ops. SMP under Xen is 5 * very straightforward. Bringing a CPU up is simply a matter of 6 * loading its initial context and setting it running. 7 * 8 * IPIs are handled through the Xen event mechanism. 9 * 10 * Because virtual CPUs can be scheduled onto any real CPU, there's no 11 * useful topology information for the kernel to make use of. As a 12 * result, all CPUs are treated as if they're single-core and 13 * single-threaded. 14 */ 15 #include <linux/sched.h> 16 #include <linux/err.h> 17 #include <linux/slab.h> 18 #include <linux/smp.h> 19 #include <linux/irq_work.h> 20 #include <linux/tick.h> 21 22 #include <asm/paravirt.h> 23 #include <asm/desc.h> 24 #include <asm/pgtable.h> 25 #include <asm/cpu.h> 26 27 #include <xen/interface/xen.h> 28 #include <xen/interface/vcpu.h> 29 #include <xen/interface/xenpmu.h> 30 31 #include <asm/xen/interface.h> 32 #include <asm/xen/hypercall.h> 33 34 #include <xen/xen.h> 35 #include <xen/page.h> 36 #include <xen/events.h> 37 38 #include <xen/hvc-console.h> 39 #include "xen-ops.h" 40 #include "mmu.h" 41 #include "smp.h" 42 #include "pmu.h" 43 44 cpumask_var_t xen_cpu_initialized_map; 45 46 struct xen_common_irq { 47 int irq; 48 char *name; 49 }; 50 static DEFINE_PER_CPU(struct xen_common_irq, xen_resched_irq) = { .irq = -1 }; 51 static DEFINE_PER_CPU(struct xen_common_irq, xen_callfunc_irq) = { .irq = -1 }; 52 static DEFINE_PER_CPU(struct xen_common_irq, xen_callfuncsingle_irq) = { .irq = -1 }; 53 static DEFINE_PER_CPU(struct xen_common_irq, xen_irq_work) = { .irq = -1 }; 54 static DEFINE_PER_CPU(struct xen_common_irq, xen_debug_irq) = { .irq = -1 }; 55 static DEFINE_PER_CPU(struct xen_common_irq, xen_pmu_irq) = { .irq = -1 }; 56 57 static irqreturn_t xen_call_function_interrupt(int irq, void *dev_id); 58 static irqreturn_t xen_call_function_single_interrupt(int irq, void *dev_id); 59 static irqreturn_t xen_irq_work_interrupt(int irq, void *dev_id); 60 61 /* 62 * Reschedule call back. 63 */ 64 static irqreturn_t xen_reschedule_interrupt(int irq, void *dev_id) 65 { 66 inc_irq_stat(irq_resched_count); 67 scheduler_ipi(); 68 69 return IRQ_HANDLED; 70 } 71 72 static void cpu_bringup(void) 73 { 74 int cpu; 75 76 cpu_init(); 77 touch_softlockup_watchdog(); 78 preempt_disable(); 79 80 /* PVH runs in ring 0 and allows us to do native syscalls. Yay! */ 81 if (!xen_feature(XENFEAT_supervisor_mode_kernel)) { 82 xen_enable_sysenter(); 83 xen_enable_syscall(); 84 } 85 cpu = smp_processor_id(); 86 smp_store_cpu_info(cpu); 87 cpu_data(cpu).x86_max_cores = 1; 88 set_cpu_sibling_map(cpu); 89 90 /* 91 * identify_cpu() may have set logical_pkg_id to -1 due 92 * to incorrect phys_proc_id. Let's re-comupte it. 93 */ 94 topology_update_package_map(apic->cpu_present_to_apicid(cpu), cpu); 95 96 xen_setup_cpu_clockevents(); 97 98 notify_cpu_starting(cpu); 99 100 set_cpu_online(cpu, true); 101 102 cpu_set_state_online(cpu); /* Implies full memory barrier. */ 103 104 /* We can take interrupts now: we're officially "up". */ 105 local_irq_enable(); 106 } 107 108 /* 109 * Note: cpu parameter is only relevant for PVH. The reason for passing it 110 * is we can't do smp_processor_id until the percpu segments are loaded, for 111 * which we need the cpu number! So we pass it in rdi as first parameter. 112 */ 113 asmlinkage __visible void cpu_bringup_and_idle(int cpu) 114 { 115 #ifdef CONFIG_XEN_PVH 116 if (xen_feature(XENFEAT_auto_translated_physmap) && 117 xen_feature(XENFEAT_supervisor_mode_kernel)) 118 xen_pvh_secondary_vcpu_init(cpu); 119 #endif 120 cpu_bringup(); 121 cpu_startup_entry(CPUHP_AP_ONLINE_IDLE); 122 } 123 124 void xen_smp_intr_free(unsigned int cpu) 125 { 126 if (per_cpu(xen_resched_irq, cpu).irq >= 0) { 127 unbind_from_irqhandler(per_cpu(xen_resched_irq, cpu).irq, NULL); 128 per_cpu(xen_resched_irq, cpu).irq = -1; 129 kfree(per_cpu(xen_resched_irq, cpu).name); 130 per_cpu(xen_resched_irq, cpu).name = NULL; 131 } 132 if (per_cpu(xen_callfunc_irq, cpu).irq >= 0) { 133 unbind_from_irqhandler(per_cpu(xen_callfunc_irq, cpu).irq, NULL); 134 per_cpu(xen_callfunc_irq, cpu).irq = -1; 135 kfree(per_cpu(xen_callfunc_irq, cpu).name); 136 per_cpu(xen_callfunc_irq, cpu).name = NULL; 137 } 138 if (per_cpu(xen_debug_irq, cpu).irq >= 0) { 139 unbind_from_irqhandler(per_cpu(xen_debug_irq, cpu).irq, NULL); 140 per_cpu(xen_debug_irq, cpu).irq = -1; 141 kfree(per_cpu(xen_debug_irq, cpu).name); 142 per_cpu(xen_debug_irq, cpu).name = NULL; 143 } 144 if (per_cpu(xen_callfuncsingle_irq, cpu).irq >= 0) { 145 unbind_from_irqhandler(per_cpu(xen_callfuncsingle_irq, cpu).irq, 146 NULL); 147 per_cpu(xen_callfuncsingle_irq, cpu).irq = -1; 148 kfree(per_cpu(xen_callfuncsingle_irq, cpu).name); 149 per_cpu(xen_callfuncsingle_irq, cpu).name = NULL; 150 } 151 if (xen_hvm_domain()) 152 return; 153 154 if (per_cpu(xen_irq_work, cpu).irq >= 0) { 155 unbind_from_irqhandler(per_cpu(xen_irq_work, cpu).irq, NULL); 156 per_cpu(xen_irq_work, cpu).irq = -1; 157 kfree(per_cpu(xen_irq_work, cpu).name); 158 per_cpu(xen_irq_work, cpu).name = NULL; 159 } 160 161 if (per_cpu(xen_pmu_irq, cpu).irq >= 0) { 162 unbind_from_irqhandler(per_cpu(xen_pmu_irq, cpu).irq, NULL); 163 per_cpu(xen_pmu_irq, cpu).irq = -1; 164 kfree(per_cpu(xen_pmu_irq, cpu).name); 165 per_cpu(xen_pmu_irq, cpu).name = NULL; 166 } 167 }; 168 int xen_smp_intr_init(unsigned int cpu) 169 { 170 int rc; 171 char *resched_name, *callfunc_name, *debug_name, *pmu_name; 172 173 resched_name = kasprintf(GFP_KERNEL, "resched%d", cpu); 174 rc = bind_ipi_to_irqhandler(XEN_RESCHEDULE_VECTOR, 175 cpu, 176 xen_reschedule_interrupt, 177 IRQF_PERCPU|IRQF_NOBALANCING, 178 resched_name, 179 NULL); 180 if (rc < 0) 181 goto fail; 182 per_cpu(xen_resched_irq, cpu).irq = rc; 183 per_cpu(xen_resched_irq, cpu).name = resched_name; 184 185 callfunc_name = kasprintf(GFP_KERNEL, "callfunc%d", cpu); 186 rc = bind_ipi_to_irqhandler(XEN_CALL_FUNCTION_VECTOR, 187 cpu, 188 xen_call_function_interrupt, 189 IRQF_PERCPU|IRQF_NOBALANCING, 190 callfunc_name, 191 NULL); 192 if (rc < 0) 193 goto fail; 194 per_cpu(xen_callfunc_irq, cpu).irq = rc; 195 per_cpu(xen_callfunc_irq, cpu).name = callfunc_name; 196 197 debug_name = kasprintf(GFP_KERNEL, "debug%d", cpu); 198 rc = bind_virq_to_irqhandler(VIRQ_DEBUG, cpu, xen_debug_interrupt, 199 IRQF_PERCPU | IRQF_NOBALANCING, 200 debug_name, NULL); 201 if (rc < 0) 202 goto fail; 203 per_cpu(xen_debug_irq, cpu).irq = rc; 204 per_cpu(xen_debug_irq, cpu).name = debug_name; 205 206 callfunc_name = kasprintf(GFP_KERNEL, "callfuncsingle%d", cpu); 207 rc = bind_ipi_to_irqhandler(XEN_CALL_FUNCTION_SINGLE_VECTOR, 208 cpu, 209 xen_call_function_single_interrupt, 210 IRQF_PERCPU|IRQF_NOBALANCING, 211 callfunc_name, 212 NULL); 213 if (rc < 0) 214 goto fail; 215 per_cpu(xen_callfuncsingle_irq, cpu).irq = rc; 216 per_cpu(xen_callfuncsingle_irq, cpu).name = callfunc_name; 217 218 /* 219 * The IRQ worker on PVHVM goes through the native path and uses the 220 * IPI mechanism. 221 */ 222 if (xen_hvm_domain()) 223 return 0; 224 225 callfunc_name = kasprintf(GFP_KERNEL, "irqwork%d", cpu); 226 rc = bind_ipi_to_irqhandler(XEN_IRQ_WORK_VECTOR, 227 cpu, 228 xen_irq_work_interrupt, 229 IRQF_PERCPU|IRQF_NOBALANCING, 230 callfunc_name, 231 NULL); 232 if (rc < 0) 233 goto fail; 234 per_cpu(xen_irq_work, cpu).irq = rc; 235 per_cpu(xen_irq_work, cpu).name = callfunc_name; 236 237 if (is_xen_pmu(cpu)) { 238 pmu_name = kasprintf(GFP_KERNEL, "pmu%d", cpu); 239 rc = bind_virq_to_irqhandler(VIRQ_XENPMU, cpu, 240 xen_pmu_irq_handler, 241 IRQF_PERCPU|IRQF_NOBALANCING, 242 pmu_name, NULL); 243 if (rc < 0) 244 goto fail; 245 per_cpu(xen_pmu_irq, cpu).irq = rc; 246 per_cpu(xen_pmu_irq, cpu).name = pmu_name; 247 } 248 249 return 0; 250 251 fail: 252 xen_smp_intr_free(cpu); 253 return rc; 254 } 255 256 static void __init xen_fill_possible_map(void) 257 { 258 int i, rc; 259 260 if (xen_initial_domain()) 261 return; 262 263 for (i = 0; i < nr_cpu_ids; i++) { 264 rc = HYPERVISOR_vcpu_op(VCPUOP_is_up, i, NULL); 265 if (rc >= 0) { 266 num_processors++; 267 set_cpu_possible(i, true); 268 } 269 } 270 } 271 272 static void __init xen_filter_cpu_maps(void) 273 { 274 int i, rc; 275 unsigned int subtract = 0; 276 277 if (!xen_initial_domain()) 278 return; 279 280 num_processors = 0; 281 disabled_cpus = 0; 282 for (i = 0; i < nr_cpu_ids; i++) { 283 rc = HYPERVISOR_vcpu_op(VCPUOP_is_up, i, NULL); 284 if (rc >= 0) { 285 num_processors++; 286 set_cpu_possible(i, true); 287 } else { 288 set_cpu_possible(i, false); 289 set_cpu_present(i, false); 290 subtract++; 291 } 292 } 293 #ifdef CONFIG_HOTPLUG_CPU 294 /* This is akin to using 'nr_cpus' on the Linux command line. 295 * Which is OK as when we use 'dom0_max_vcpus=X' we can only 296 * have up to X, while nr_cpu_ids is greater than X. This 297 * normally is not a problem, except when CPU hotplugging 298 * is involved and then there might be more than X CPUs 299 * in the guest - which will not work as there is no 300 * hypercall to expand the max number of VCPUs an already 301 * running guest has. So cap it up to X. */ 302 if (subtract) 303 nr_cpu_ids = nr_cpu_ids - subtract; 304 #endif 305 306 } 307 308 static void __init xen_smp_prepare_boot_cpu(void) 309 { 310 BUG_ON(smp_processor_id() != 0); 311 native_smp_prepare_boot_cpu(); 312 313 if (xen_pv_domain()) { 314 if (!xen_feature(XENFEAT_writable_page_tables)) 315 /* We've switched to the "real" per-cpu gdt, so make 316 * sure the old memory can be recycled. */ 317 make_lowmem_page_readwrite(xen_initial_gdt); 318 319 #ifdef CONFIG_X86_32 320 /* 321 * Xen starts us with XEN_FLAT_RING1_DS, but linux code 322 * expects __USER_DS 323 */ 324 loadsegment(ds, __USER_DS); 325 loadsegment(es, __USER_DS); 326 #endif 327 328 xen_filter_cpu_maps(); 329 xen_setup_vcpu_info_placement(); 330 } 331 332 /* 333 * Setup vcpu_info for boot CPU. 334 */ 335 if (xen_hvm_domain()) 336 xen_vcpu_setup(0); 337 338 /* 339 * The alternative logic (which patches the unlock/lock) runs before 340 * the smp bootup up code is activated. Hence we need to set this up 341 * the core kernel is being patched. Otherwise we will have only 342 * modules patched but not core code. 343 */ 344 xen_init_spinlocks(); 345 } 346 347 static void __init xen_smp_prepare_cpus(unsigned int max_cpus) 348 { 349 unsigned cpu; 350 unsigned int i; 351 352 if (skip_ioapic_setup) { 353 char *m = (max_cpus == 0) ? 354 "The nosmp parameter is incompatible with Xen; " \ 355 "use Xen dom0_max_vcpus=1 parameter" : 356 "The noapic parameter is incompatible with Xen"; 357 358 xen_raw_printk(m); 359 panic(m); 360 } 361 xen_init_lock_cpu(0); 362 363 smp_store_boot_cpu_info(); 364 cpu_data(0).x86_max_cores = 1; 365 366 for_each_possible_cpu(i) { 367 zalloc_cpumask_var(&per_cpu(cpu_sibling_map, i), GFP_KERNEL); 368 zalloc_cpumask_var(&per_cpu(cpu_core_map, i), GFP_KERNEL); 369 zalloc_cpumask_var(&per_cpu(cpu_llc_shared_map, i), GFP_KERNEL); 370 } 371 set_cpu_sibling_map(0); 372 373 xen_pmu_init(0); 374 375 if (xen_smp_intr_init(0)) 376 BUG(); 377 378 if (!alloc_cpumask_var(&xen_cpu_initialized_map, GFP_KERNEL)) 379 panic("could not allocate xen_cpu_initialized_map\n"); 380 381 cpumask_copy(xen_cpu_initialized_map, cpumask_of(0)); 382 383 /* Restrict the possible_map according to max_cpus. */ 384 while ((num_possible_cpus() > 1) && (num_possible_cpus() > max_cpus)) { 385 for (cpu = nr_cpu_ids - 1; !cpu_possible(cpu); cpu--) 386 continue; 387 set_cpu_possible(cpu, false); 388 } 389 390 for_each_possible_cpu(cpu) 391 set_cpu_present(cpu, true); 392 } 393 394 static int 395 cpu_initialize_context(unsigned int cpu, struct task_struct *idle) 396 { 397 struct vcpu_guest_context *ctxt; 398 struct desc_struct *gdt; 399 unsigned long gdt_mfn; 400 401 /* used to tell cpu_init() that it can proceed with initialization */ 402 cpumask_set_cpu(cpu, cpu_callout_mask); 403 if (cpumask_test_and_set_cpu(cpu, xen_cpu_initialized_map)) 404 return 0; 405 406 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL); 407 if (ctxt == NULL) 408 return -ENOMEM; 409 410 gdt = get_cpu_gdt_table(cpu); 411 412 #ifdef CONFIG_X86_32 413 /* Note: PVH is not yet supported on x86_32. */ 414 ctxt->user_regs.fs = __KERNEL_PERCPU; 415 ctxt->user_regs.gs = __KERNEL_STACK_CANARY; 416 #endif 417 memset(&ctxt->fpu_ctxt, 0, sizeof(ctxt->fpu_ctxt)); 418 419 if (!xen_feature(XENFEAT_auto_translated_physmap)) { 420 ctxt->user_regs.eip = (unsigned long)cpu_bringup_and_idle; 421 ctxt->flags = VGCF_IN_KERNEL; 422 ctxt->user_regs.eflags = 0x1000; /* IOPL_RING1 */ 423 ctxt->user_regs.ds = __USER_DS; 424 ctxt->user_regs.es = __USER_DS; 425 ctxt->user_regs.ss = __KERNEL_DS; 426 427 xen_copy_trap_info(ctxt->trap_ctxt); 428 429 ctxt->ldt_ents = 0; 430 431 BUG_ON((unsigned long)gdt & ~PAGE_MASK); 432 433 gdt_mfn = arbitrary_virt_to_mfn(gdt); 434 make_lowmem_page_readonly(gdt); 435 make_lowmem_page_readonly(mfn_to_virt(gdt_mfn)); 436 437 ctxt->gdt_frames[0] = gdt_mfn; 438 ctxt->gdt_ents = GDT_ENTRIES; 439 440 ctxt->kernel_ss = __KERNEL_DS; 441 ctxt->kernel_sp = idle->thread.sp0; 442 443 #ifdef CONFIG_X86_32 444 ctxt->event_callback_cs = __KERNEL_CS; 445 ctxt->failsafe_callback_cs = __KERNEL_CS; 446 #else 447 ctxt->gs_base_kernel = per_cpu_offset(cpu); 448 #endif 449 ctxt->event_callback_eip = 450 (unsigned long)xen_hypervisor_callback; 451 ctxt->failsafe_callback_eip = 452 (unsigned long)xen_failsafe_callback; 453 ctxt->user_regs.cs = __KERNEL_CS; 454 per_cpu(xen_cr3, cpu) = __pa(swapper_pg_dir); 455 } 456 #ifdef CONFIG_XEN_PVH 457 else { 458 /* 459 * The vcpu comes on kernel page tables which have the NX pte 460 * bit set. This means before DS/SS is touched, NX in 461 * EFER must be set. Hence the following assembly glue code. 462 */ 463 ctxt->user_regs.eip = (unsigned long)xen_pvh_early_cpu_init; 464 ctxt->user_regs.rdi = cpu; 465 ctxt->user_regs.rsi = true; /* entry == true */ 466 } 467 #endif 468 ctxt->user_regs.esp = idle->thread.sp0 - sizeof(struct pt_regs); 469 ctxt->ctrlreg[3] = xen_pfn_to_cr3(virt_to_gfn(swapper_pg_dir)); 470 if (HYPERVISOR_vcpu_op(VCPUOP_initialise, xen_vcpu_nr(cpu), ctxt)) 471 BUG(); 472 473 kfree(ctxt); 474 return 0; 475 } 476 477 static int xen_cpu_up(unsigned int cpu, struct task_struct *idle) 478 { 479 int rc; 480 481 common_cpu_up(cpu, idle); 482 483 xen_setup_runstate_info(cpu); 484 485 /* 486 * PV VCPUs are always successfully taken down (see 'while' loop 487 * in xen_cpu_die()), so -EBUSY is an error. 488 */ 489 rc = cpu_check_up_prepare(cpu); 490 if (rc) 491 return rc; 492 493 /* make sure interrupts start blocked */ 494 per_cpu(xen_vcpu, cpu)->evtchn_upcall_mask = 1; 495 496 rc = cpu_initialize_context(cpu, idle); 497 if (rc) 498 return rc; 499 500 xen_pmu_init(cpu); 501 502 rc = HYPERVISOR_vcpu_op(VCPUOP_up, xen_vcpu_nr(cpu), NULL); 503 BUG_ON(rc); 504 505 while (cpu_report_state(cpu) != CPU_ONLINE) 506 HYPERVISOR_sched_op(SCHEDOP_yield, NULL); 507 508 return 0; 509 } 510 511 static void xen_smp_cpus_done(unsigned int max_cpus) 512 { 513 } 514 515 #ifdef CONFIG_HOTPLUG_CPU 516 static int xen_cpu_disable(void) 517 { 518 unsigned int cpu = smp_processor_id(); 519 if (cpu == 0) 520 return -EBUSY; 521 522 cpu_disable_common(); 523 524 load_cr3(swapper_pg_dir); 525 return 0; 526 } 527 528 static void xen_cpu_die(unsigned int cpu) 529 { 530 while (xen_pv_domain() && HYPERVISOR_vcpu_op(VCPUOP_is_up, 531 xen_vcpu_nr(cpu), NULL)) { 532 __set_current_state(TASK_UNINTERRUPTIBLE); 533 schedule_timeout(HZ/10); 534 } 535 536 if (common_cpu_die(cpu) == 0) { 537 xen_smp_intr_free(cpu); 538 xen_uninit_lock_cpu(cpu); 539 xen_teardown_timer(cpu); 540 xen_pmu_finish(cpu); 541 } 542 } 543 544 static void xen_play_dead(void) /* used only with HOTPLUG_CPU */ 545 { 546 play_dead_common(); 547 HYPERVISOR_vcpu_op(VCPUOP_down, xen_vcpu_nr(smp_processor_id()), NULL); 548 cpu_bringup(); 549 /* 550 * commit 4b0c0f294 (tick: Cleanup NOHZ per cpu data on cpu down) 551 * clears certain data that the cpu_idle loop (which called us 552 * and that we return from) expects. The only way to get that 553 * data back is to call: 554 */ 555 tick_nohz_idle_enter(); 556 557 cpu_startup_entry(CPUHP_AP_ONLINE_IDLE); 558 } 559 560 #else /* !CONFIG_HOTPLUG_CPU */ 561 static int xen_cpu_disable(void) 562 { 563 return -ENOSYS; 564 } 565 566 static void xen_cpu_die(unsigned int cpu) 567 { 568 BUG(); 569 } 570 571 static void xen_play_dead(void) 572 { 573 BUG(); 574 } 575 576 #endif 577 static void stop_self(void *v) 578 { 579 int cpu = smp_processor_id(); 580 581 /* make sure we're not pinning something down */ 582 load_cr3(swapper_pg_dir); 583 /* should set up a minimal gdt */ 584 585 set_cpu_online(cpu, false); 586 587 HYPERVISOR_vcpu_op(VCPUOP_down, xen_vcpu_nr(cpu), NULL); 588 BUG(); 589 } 590 591 static void xen_stop_other_cpus(int wait) 592 { 593 smp_call_function(stop_self, NULL, wait); 594 } 595 596 static void xen_smp_send_reschedule(int cpu) 597 { 598 xen_send_IPI_one(cpu, XEN_RESCHEDULE_VECTOR); 599 } 600 601 static void __xen_send_IPI_mask(const struct cpumask *mask, 602 int vector) 603 { 604 unsigned cpu; 605 606 for_each_cpu_and(cpu, mask, cpu_online_mask) 607 xen_send_IPI_one(cpu, vector); 608 } 609 610 static void xen_smp_send_call_function_ipi(const struct cpumask *mask) 611 { 612 int cpu; 613 614 __xen_send_IPI_mask(mask, XEN_CALL_FUNCTION_VECTOR); 615 616 /* Make sure other vcpus get a chance to run if they need to. */ 617 for_each_cpu(cpu, mask) { 618 if (xen_vcpu_stolen(cpu)) { 619 HYPERVISOR_sched_op(SCHEDOP_yield, NULL); 620 break; 621 } 622 } 623 } 624 625 static void xen_smp_send_call_function_single_ipi(int cpu) 626 { 627 __xen_send_IPI_mask(cpumask_of(cpu), 628 XEN_CALL_FUNCTION_SINGLE_VECTOR); 629 } 630 631 static inline int xen_map_vector(int vector) 632 { 633 int xen_vector; 634 635 switch (vector) { 636 case RESCHEDULE_VECTOR: 637 xen_vector = XEN_RESCHEDULE_VECTOR; 638 break; 639 case CALL_FUNCTION_VECTOR: 640 xen_vector = XEN_CALL_FUNCTION_VECTOR; 641 break; 642 case CALL_FUNCTION_SINGLE_VECTOR: 643 xen_vector = XEN_CALL_FUNCTION_SINGLE_VECTOR; 644 break; 645 case IRQ_WORK_VECTOR: 646 xen_vector = XEN_IRQ_WORK_VECTOR; 647 break; 648 #ifdef CONFIG_X86_64 649 case NMI_VECTOR: 650 case APIC_DM_NMI: /* Some use that instead of NMI_VECTOR */ 651 xen_vector = XEN_NMI_VECTOR; 652 break; 653 #endif 654 default: 655 xen_vector = -1; 656 printk(KERN_ERR "xen: vector 0x%x is not implemented\n", 657 vector); 658 } 659 660 return xen_vector; 661 } 662 663 void xen_send_IPI_mask(const struct cpumask *mask, 664 int vector) 665 { 666 int xen_vector = xen_map_vector(vector); 667 668 if (xen_vector >= 0) 669 __xen_send_IPI_mask(mask, xen_vector); 670 } 671 672 void xen_send_IPI_all(int vector) 673 { 674 int xen_vector = xen_map_vector(vector); 675 676 if (xen_vector >= 0) 677 __xen_send_IPI_mask(cpu_online_mask, xen_vector); 678 } 679 680 void xen_send_IPI_self(int vector) 681 { 682 int xen_vector = xen_map_vector(vector); 683 684 if (xen_vector >= 0) 685 xen_send_IPI_one(smp_processor_id(), xen_vector); 686 } 687 688 void xen_send_IPI_mask_allbutself(const struct cpumask *mask, 689 int vector) 690 { 691 unsigned cpu; 692 unsigned int this_cpu = smp_processor_id(); 693 int xen_vector = xen_map_vector(vector); 694 695 if (!(num_online_cpus() > 1) || (xen_vector < 0)) 696 return; 697 698 for_each_cpu_and(cpu, mask, cpu_online_mask) { 699 if (this_cpu == cpu) 700 continue; 701 702 xen_send_IPI_one(cpu, xen_vector); 703 } 704 } 705 706 void xen_send_IPI_allbutself(int vector) 707 { 708 xen_send_IPI_mask_allbutself(cpu_online_mask, vector); 709 } 710 711 static irqreturn_t xen_call_function_interrupt(int irq, void *dev_id) 712 { 713 irq_enter(); 714 generic_smp_call_function_interrupt(); 715 inc_irq_stat(irq_call_count); 716 irq_exit(); 717 718 return IRQ_HANDLED; 719 } 720 721 static irqreturn_t xen_call_function_single_interrupt(int irq, void *dev_id) 722 { 723 irq_enter(); 724 generic_smp_call_function_single_interrupt(); 725 inc_irq_stat(irq_call_count); 726 irq_exit(); 727 728 return IRQ_HANDLED; 729 } 730 731 static irqreturn_t xen_irq_work_interrupt(int irq, void *dev_id) 732 { 733 irq_enter(); 734 irq_work_run(); 735 inc_irq_stat(apic_irq_work_irqs); 736 irq_exit(); 737 738 return IRQ_HANDLED; 739 } 740 741 static const struct smp_ops xen_smp_ops __initconst = { 742 .smp_prepare_boot_cpu = xen_smp_prepare_boot_cpu, 743 .smp_prepare_cpus = xen_smp_prepare_cpus, 744 .smp_cpus_done = xen_smp_cpus_done, 745 746 .cpu_up = xen_cpu_up, 747 .cpu_die = xen_cpu_die, 748 .cpu_disable = xen_cpu_disable, 749 .play_dead = xen_play_dead, 750 751 .stop_other_cpus = xen_stop_other_cpus, 752 .smp_send_reschedule = xen_smp_send_reschedule, 753 754 .send_call_func_ipi = xen_smp_send_call_function_ipi, 755 .send_call_func_single_ipi = xen_smp_send_call_function_single_ipi, 756 }; 757 758 void __init xen_smp_init(void) 759 { 760 smp_ops = xen_smp_ops; 761 xen_fill_possible_map(); 762 } 763 764 static void __init xen_hvm_smp_prepare_cpus(unsigned int max_cpus) 765 { 766 native_smp_prepare_cpus(max_cpus); 767 WARN_ON(xen_smp_intr_init(0)); 768 769 xen_init_lock_cpu(0); 770 } 771 772 void __init xen_hvm_smp_init(void) 773 { 774 smp_ops.smp_prepare_cpus = xen_hvm_smp_prepare_cpus; 775 smp_ops.smp_send_reschedule = xen_smp_send_reschedule; 776 smp_ops.cpu_die = xen_cpu_die; 777 smp_ops.send_call_func_ipi = xen_smp_send_call_function_ipi; 778 smp_ops.send_call_func_single_ipi = xen_smp_send_call_function_single_ipi; 779 smp_ops.smp_prepare_boot_cpu = xen_smp_prepare_boot_cpu; 780 } 781