forked from Minki/linux
d176720d34
On emergency_restart, we may need to use an NMI to disable virtualization on all CPUs. We do that using nmi_shootdown_cpus() if VMX is enabled. Note: With this patch, we will run the NMI stuff only when the CPU where emergency_restart() was called has VMX enabled. This should work on most cases because KVM enables VMX on all CPUs, but we may miss the small window where KVM is doing that. Also, I don't know if all code using VMX out there always enable VMX on all CPUs like KVM does. We have two other alternatives for that: a) Have an API that all code that enables VMX on any CPU should use to tell the kernel core that it is going to enable VMX on the CPUs. b) Always call nmi_shootdown_cpus() if the CPU supports VMX. This is a bit intrusive and more risky, as it would run nmi_shootdown_cpus() on emergency_reboot() even on systems where virtualization is never enabled. Finding a proper point to hook the nmi_shootdown_cpus() call isn't trivial, as the non-emergency machine_restart() (that doesn't need the NMI tricks) uses machine_emergency_restart() directly. The solution to make this work without adding a new function or argument to machine_ops was setting a 'reboot_emergency' flag that tells if native_machine_emergency_restart() needs to do the virt cleanup or not. Signed-off-by: Eduardo Habkost <ehabkost@redhat.com> Signed-off-by: Avi Kivity <avi@redhat.com>
704 lines
18 KiB
C
704 lines
18 KiB
C
#include <linux/module.h>
|
|
#include <linux/reboot.h>
|
|
#include <linux/init.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/efi.h>
|
|
#include <acpi/reboot.h>
|
|
#include <asm/io.h>
|
|
#include <asm/apic.h>
|
|
#include <asm/desc.h>
|
|
#include <asm/hpet.h>
|
|
#include <asm/pgtable.h>
|
|
#include <asm/proto.h>
|
|
#include <asm/reboot_fixups.h>
|
|
#include <asm/reboot.h>
|
|
#include <asm/virtext.h>
|
|
|
|
#ifdef CONFIG_X86_32
|
|
# include <linux/dmi.h>
|
|
# include <linux/ctype.h>
|
|
# include <linux/mc146818rtc.h>
|
|
#else
|
|
# include <asm/iommu.h>
|
|
#endif
|
|
|
|
#include <mach_ipi.h>
|
|
|
|
|
|
/*
|
|
* Power off function, if any
|
|
*/
|
|
void (*pm_power_off)(void);
|
|
EXPORT_SYMBOL(pm_power_off);
|
|
|
|
static const struct desc_ptr no_idt = {};
|
|
static int reboot_mode;
|
|
enum reboot_type reboot_type = BOOT_KBD;
|
|
int reboot_force;
|
|
|
|
#if defined(CONFIG_X86_32) && defined(CONFIG_SMP)
|
|
static int reboot_cpu = -1;
|
|
#endif
|
|
|
|
/* This is set if we need to go through the 'emergency' path.
|
|
* When machine_emergency_restart() is called, we may be on
|
|
* an inconsistent state and won't be able to do a clean cleanup
|
|
*/
|
|
static int reboot_emergency;
|
|
|
|
/* This is set by the PCI code if either type 1 or type 2 PCI is detected */
|
|
bool port_cf9_safe = false;
|
|
|
|
/* reboot=b[ios] | s[mp] | t[riple] | k[bd] | e[fi] [, [w]arm | [c]old] | p[ci]
|
|
warm Don't set the cold reboot flag
|
|
cold Set the cold reboot flag
|
|
bios Reboot by jumping through the BIOS (only for X86_32)
|
|
smp Reboot by executing reset on BSP or other CPU (only for X86_32)
|
|
triple Force a triple fault (init)
|
|
kbd Use the keyboard controller. cold reset (default)
|
|
acpi Use the RESET_REG in the FADT
|
|
efi Use efi reset_system runtime service
|
|
pci Use the so-called "PCI reset register", CF9
|
|
force Avoid anything that could hang.
|
|
*/
|
|
static int __init reboot_setup(char *str)
|
|
{
|
|
for (;;) {
|
|
switch (*str) {
|
|
case 'w':
|
|
reboot_mode = 0x1234;
|
|
break;
|
|
|
|
case 'c':
|
|
reboot_mode = 0;
|
|
break;
|
|
|
|
#ifdef CONFIG_X86_32
|
|
#ifdef CONFIG_SMP
|
|
case 's':
|
|
if (isdigit(*(str+1))) {
|
|
reboot_cpu = (int) (*(str+1) - '0');
|
|
if (isdigit(*(str+2)))
|
|
reboot_cpu = reboot_cpu*10 + (int)(*(str+2) - '0');
|
|
}
|
|
/* we will leave sorting out the final value
|
|
when we are ready to reboot, since we might not
|
|
have set up boot_cpu_id or smp_num_cpu */
|
|
break;
|
|
#endif /* CONFIG_SMP */
|
|
|
|
case 'b':
|
|
#endif
|
|
case 'a':
|
|
case 'k':
|
|
case 't':
|
|
case 'e':
|
|
case 'p':
|
|
reboot_type = *str;
|
|
break;
|
|
|
|
case 'f':
|
|
reboot_force = 1;
|
|
break;
|
|
}
|
|
|
|
str = strchr(str, ',');
|
|
if (str)
|
|
str++;
|
|
else
|
|
break;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
__setup("reboot=", reboot_setup);
|
|
|
|
|
|
#ifdef CONFIG_X86_32
|
|
/*
|
|
* Reboot options and system auto-detection code provided by
|
|
* Dell Inc. so their systems "just work". :-)
|
|
*/
|
|
|
|
/*
|
|
* Some machines require the "reboot=b" commandline option,
|
|
* this quirk makes that automatic.
|
|
*/
|
|
static int __init set_bios_reboot(const struct dmi_system_id *d)
|
|
{
|
|
if (reboot_type != BOOT_BIOS) {
|
|
reboot_type = BOOT_BIOS;
|
|
printk(KERN_INFO "%s series board detected. Selecting BIOS-method for reboots.\n", d->ident);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static struct dmi_system_id __initdata reboot_dmi_table[] = {
|
|
{ /* Handle problems with rebooting on Dell E520's */
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell E520",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "Dell DM061"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on Dell 1300's */
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell PowerEdge 1300",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Computer Corporation"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "PowerEdge 1300/"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on Dell 300's */
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell PowerEdge 300",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Computer Corporation"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "PowerEdge 300/"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on Dell Optiplex 745's SFF*/
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell OptiPlex 745",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "OptiPlex 745"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on Dell Optiplex 745's DFF*/
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell OptiPlex 745",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "OptiPlex 745"),
|
|
DMI_MATCH(DMI_BOARD_NAME, "0MM599"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on Dell Optiplex 745 with 0KW626 */
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell OptiPlex 745",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "OptiPlex 745"),
|
|
DMI_MATCH(DMI_BOARD_NAME, "0KW626"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on Dell Optiplex 330 with 0KP561 */
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell OptiPlex 330",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "OptiPlex 330"),
|
|
DMI_MATCH(DMI_BOARD_NAME, "0KP561"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on Dell 2400's */
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell PowerEdge 2400",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Computer Corporation"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "PowerEdge 2400"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on Dell T5400's */
|
|
.callback = set_bios_reboot,
|
|
.ident = "Dell Precision T5400",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "Precision WorkStation T5400"),
|
|
},
|
|
},
|
|
{ /* Handle problems with rebooting on HP laptops */
|
|
.callback = set_bios_reboot,
|
|
.ident = "HP Compaq Laptop",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "HP Compaq"),
|
|
},
|
|
},
|
|
{ }
|
|
};
|
|
|
|
static int __init reboot_init(void)
|
|
{
|
|
dmi_check_system(reboot_dmi_table);
|
|
return 0;
|
|
}
|
|
core_initcall(reboot_init);
|
|
|
|
/* The following code and data reboots the machine by switching to real
|
|
mode and jumping to the BIOS reset entry point, as if the CPU has
|
|
really been reset. The previous version asked the keyboard
|
|
controller to pulse the CPU reset line, which is more thorough, but
|
|
doesn't work with at least one type of 486 motherboard. It is easy
|
|
to stop this code working; hence the copious comments. */
|
|
static const unsigned long long
|
|
real_mode_gdt_entries [3] =
|
|
{
|
|
0x0000000000000000ULL, /* Null descriptor */
|
|
0x00009b000000ffffULL, /* 16-bit real-mode 64k code at 0x00000000 */
|
|
0x000093000100ffffULL /* 16-bit real-mode 64k data at 0x00000100 */
|
|
};
|
|
|
|
static const struct desc_ptr
|
|
real_mode_gdt = { sizeof (real_mode_gdt_entries) - 1, (long)real_mode_gdt_entries },
|
|
real_mode_idt = { 0x3ff, 0 };
|
|
|
|
/* This is 16-bit protected mode code to disable paging and the cache,
|
|
switch to real mode and jump to the BIOS reset code.
|
|
|
|
The instruction that switches to real mode by writing to CR0 must be
|
|
followed immediately by a far jump instruction, which set CS to a
|
|
valid value for real mode, and flushes the prefetch queue to avoid
|
|
running instructions that have already been decoded in protected
|
|
mode.
|
|
|
|
Clears all the flags except ET, especially PG (paging), PE
|
|
(protected-mode enable) and TS (task switch for coprocessor state
|
|
save). Flushes the TLB after paging has been disabled. Sets CD and
|
|
NW, to disable the cache on a 486, and invalidates the cache. This
|
|
is more like the state of a 486 after reset. I don't know if
|
|
something else should be done for other chips.
|
|
|
|
More could be done here to set up the registers as if a CPU reset had
|
|
occurred; hopefully real BIOSs don't assume much. */
|
|
static const unsigned char real_mode_switch [] =
|
|
{
|
|
0x66, 0x0f, 0x20, 0xc0, /* movl %cr0,%eax */
|
|
0x66, 0x83, 0xe0, 0x11, /* andl $0x00000011,%eax */
|
|
0x66, 0x0d, 0x00, 0x00, 0x00, 0x60, /* orl $0x60000000,%eax */
|
|
0x66, 0x0f, 0x22, 0xc0, /* movl %eax,%cr0 */
|
|
0x66, 0x0f, 0x22, 0xd8, /* movl %eax,%cr3 */
|
|
0x66, 0x0f, 0x20, 0xc3, /* movl %cr0,%ebx */
|
|
0x66, 0x81, 0xe3, 0x00, 0x00, 0x00, 0x60, /* andl $0x60000000,%ebx */
|
|
0x74, 0x02, /* jz f */
|
|
0x0f, 0x09, /* wbinvd */
|
|
0x24, 0x10, /* f: andb $0x10,al */
|
|
0x66, 0x0f, 0x22, 0xc0 /* movl %eax,%cr0 */
|
|
};
|
|
static const unsigned char jump_to_bios [] =
|
|
{
|
|
0xea, 0x00, 0x00, 0xff, 0xff /* ljmp $0xffff,$0x0000 */
|
|
};
|
|
|
|
/*
|
|
* Switch to real mode and then execute the code
|
|
* specified by the code and length parameters.
|
|
* We assume that length will aways be less that 100!
|
|
*/
|
|
void machine_real_restart(const unsigned char *code, int length)
|
|
{
|
|
local_irq_disable();
|
|
|
|
/* Write zero to CMOS register number 0x0f, which the BIOS POST
|
|
routine will recognize as telling it to do a proper reboot. (Well
|
|
that's what this book in front of me says -- it may only apply to
|
|
the Phoenix BIOS though, it's not clear). At the same time,
|
|
disable NMIs by setting the top bit in the CMOS address register,
|
|
as we're about to do peculiar things to the CPU. I'm not sure if
|
|
`outb_p' is needed instead of just `outb'. Use it to be on the
|
|
safe side. (Yes, CMOS_WRITE does outb_p's. - Paul G.)
|
|
*/
|
|
spin_lock(&rtc_lock);
|
|
CMOS_WRITE(0x00, 0x8f);
|
|
spin_unlock(&rtc_lock);
|
|
|
|
/* Remap the kernel at virtual address zero, as well as offset zero
|
|
from the kernel segment. This assumes the kernel segment starts at
|
|
virtual address PAGE_OFFSET. */
|
|
memcpy(swapper_pg_dir, swapper_pg_dir + KERNEL_PGD_BOUNDARY,
|
|
sizeof(swapper_pg_dir [0]) * KERNEL_PGD_PTRS);
|
|
|
|
/*
|
|
* Use `swapper_pg_dir' as our page directory.
|
|
*/
|
|
load_cr3(swapper_pg_dir);
|
|
|
|
/* Write 0x1234 to absolute memory location 0x472. The BIOS reads
|
|
this on booting to tell it to "Bypass memory test (also warm
|
|
boot)". This seems like a fairly standard thing that gets set by
|
|
REBOOT.COM programs, and the previous reset routine did this
|
|
too. */
|
|
*((unsigned short *)0x472) = reboot_mode;
|
|
|
|
/* For the switch to real mode, copy some code to low memory. It has
|
|
to be in the first 64k because it is running in 16-bit mode, and it
|
|
has to have the same physical and virtual address, because it turns
|
|
off paging. Copy it near the end of the first page, out of the way
|
|
of BIOS variables. */
|
|
memcpy((void *)(0x1000 - sizeof(real_mode_switch) - 100),
|
|
real_mode_switch, sizeof (real_mode_switch));
|
|
memcpy((void *)(0x1000 - 100), code, length);
|
|
|
|
/* Set up the IDT for real mode. */
|
|
load_idt(&real_mode_idt);
|
|
|
|
/* Set up a GDT from which we can load segment descriptors for real
|
|
mode. The GDT is not used in real mode; it is just needed here to
|
|
prepare the descriptors. */
|
|
load_gdt(&real_mode_gdt);
|
|
|
|
/* Load the data segment registers, and thus the descriptors ready for
|
|
real mode. The base address of each segment is 0x100, 16 times the
|
|
selector value being loaded here. This is so that the segment
|
|
registers don't have to be reloaded after switching to real mode:
|
|
the values are consistent for real mode operation already. */
|
|
__asm__ __volatile__ ("movl $0x0010,%%eax\n"
|
|
"\tmovl %%eax,%%ds\n"
|
|
"\tmovl %%eax,%%es\n"
|
|
"\tmovl %%eax,%%fs\n"
|
|
"\tmovl %%eax,%%gs\n"
|
|
"\tmovl %%eax,%%ss" : : : "eax");
|
|
|
|
/* Jump to the 16-bit code that we copied earlier. It disables paging
|
|
and the cache, switches to real mode, and jumps to the BIOS reset
|
|
entry point. */
|
|
__asm__ __volatile__ ("ljmp $0x0008,%0"
|
|
:
|
|
: "i" ((void *)(0x1000 - sizeof (real_mode_switch) - 100)));
|
|
}
|
|
#ifdef CONFIG_APM_MODULE
|
|
EXPORT_SYMBOL(machine_real_restart);
|
|
#endif
|
|
|
|
#endif /* CONFIG_X86_32 */
|
|
|
|
static inline void kb_wait(void)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < 0x10000; i++) {
|
|
if ((inb(0x64) & 0x02) == 0)
|
|
break;
|
|
udelay(2);
|
|
}
|
|
}
|
|
|
|
static void vmxoff_nmi(int cpu, struct die_args *args)
|
|
{
|
|
cpu_emergency_vmxoff();
|
|
}
|
|
|
|
/* Use NMIs as IPIs to tell all CPUs to disable virtualization
|
|
*/
|
|
static void emergency_vmx_disable_all(void)
|
|
{
|
|
/* Just make sure we won't change CPUs while doing this */
|
|
local_irq_disable();
|
|
|
|
/* We need to disable VMX on all CPUs before rebooting, otherwise
|
|
* we risk hanging up the machine, because the CPU ignore INIT
|
|
* signals when VMX is enabled.
|
|
*
|
|
* We can't take any locks and we may be on an inconsistent
|
|
* state, so we use NMIs as IPIs to tell the other CPUs to disable
|
|
* VMX and halt.
|
|
*
|
|
* For safety, we will avoid running the nmi_shootdown_cpus()
|
|
* stuff unnecessarily, but we don't have a way to check
|
|
* if other CPUs have VMX enabled. So we will call it only if the
|
|
* CPU we are running on has VMX enabled.
|
|
*
|
|
* We will miss cases where VMX is not enabled on all CPUs. This
|
|
* shouldn't do much harm because KVM always enable VMX on all
|
|
* CPUs anyway. But we can miss it on the small window where KVM
|
|
* is still enabling VMX.
|
|
*/
|
|
if (cpu_has_vmx() && cpu_vmx_enabled()) {
|
|
/* Disable VMX on this CPU.
|
|
*/
|
|
cpu_vmxoff();
|
|
|
|
/* Halt and disable VMX on the other CPUs */
|
|
nmi_shootdown_cpus(vmxoff_nmi);
|
|
|
|
}
|
|
}
|
|
|
|
|
|
void __attribute__((weak)) mach_reboot_fixups(void)
|
|
{
|
|
}
|
|
|
|
static void native_machine_emergency_restart(void)
|
|
{
|
|
int i;
|
|
|
|
if (reboot_emergency)
|
|
emergency_vmx_disable_all();
|
|
|
|
/* Tell the BIOS if we want cold or warm reboot */
|
|
*((unsigned short *)__va(0x472)) = reboot_mode;
|
|
|
|
for (;;) {
|
|
/* Could also try the reset bit in the Hammer NB */
|
|
switch (reboot_type) {
|
|
case BOOT_KBD:
|
|
mach_reboot_fixups(); /* for board specific fixups */
|
|
|
|
for (i = 0; i < 10; i++) {
|
|
kb_wait();
|
|
udelay(50);
|
|
outb(0xfe, 0x64); /* pulse reset low */
|
|
udelay(50);
|
|
}
|
|
|
|
case BOOT_TRIPLE:
|
|
load_idt(&no_idt);
|
|
__asm__ __volatile__("int3");
|
|
|
|
reboot_type = BOOT_KBD;
|
|
break;
|
|
|
|
#ifdef CONFIG_X86_32
|
|
case BOOT_BIOS:
|
|
machine_real_restart(jump_to_bios, sizeof(jump_to_bios));
|
|
|
|
reboot_type = BOOT_KBD;
|
|
break;
|
|
#endif
|
|
|
|
case BOOT_ACPI:
|
|
acpi_reboot();
|
|
reboot_type = BOOT_KBD;
|
|
break;
|
|
|
|
case BOOT_EFI:
|
|
if (efi_enabled)
|
|
efi.reset_system(reboot_mode ?
|
|
EFI_RESET_WARM :
|
|
EFI_RESET_COLD,
|
|
EFI_SUCCESS, 0, NULL);
|
|
reboot_type = BOOT_KBD;
|
|
break;
|
|
|
|
case BOOT_CF9:
|
|
port_cf9_safe = true;
|
|
/* fall through */
|
|
|
|
case BOOT_CF9_COND:
|
|
if (port_cf9_safe) {
|
|
u8 cf9 = inb(0xcf9) & ~6;
|
|
outb(cf9|2, 0xcf9); /* Request hard reset */
|
|
udelay(50);
|
|
outb(cf9|6, 0xcf9); /* Actually do the reset */
|
|
udelay(50);
|
|
}
|
|
reboot_type = BOOT_KBD;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void native_machine_shutdown(void)
|
|
{
|
|
/* Stop the cpus and apics */
|
|
#ifdef CONFIG_SMP
|
|
|
|
/* The boot cpu is always logical cpu 0 */
|
|
int reboot_cpu_id = 0;
|
|
|
|
#ifdef CONFIG_X86_32
|
|
/* See if there has been given a command line override */
|
|
if ((reboot_cpu != -1) && (reboot_cpu < NR_CPUS) &&
|
|
cpu_online(reboot_cpu))
|
|
reboot_cpu_id = reboot_cpu;
|
|
#endif
|
|
|
|
/* Make certain the cpu I'm about to reboot on is online */
|
|
if (!cpu_online(reboot_cpu_id))
|
|
reboot_cpu_id = smp_processor_id();
|
|
|
|
/* Make certain I only run on the appropriate processor */
|
|
set_cpus_allowed_ptr(current, &cpumask_of_cpu(reboot_cpu_id));
|
|
|
|
/* O.K Now that I'm on the appropriate processor,
|
|
* stop all of the others.
|
|
*/
|
|
smp_send_stop();
|
|
#endif
|
|
|
|
lapic_shutdown();
|
|
|
|
#ifdef CONFIG_X86_IO_APIC
|
|
disable_IO_APIC();
|
|
#endif
|
|
|
|
#ifdef CONFIG_HPET_TIMER
|
|
hpet_disable();
|
|
#endif
|
|
|
|
#ifdef CONFIG_X86_64
|
|
pci_iommu_shutdown();
|
|
#endif
|
|
}
|
|
|
|
static void __machine_emergency_restart(int emergency)
|
|
{
|
|
reboot_emergency = emergency;
|
|
machine_ops.emergency_restart();
|
|
}
|
|
|
|
static void native_machine_restart(char *__unused)
|
|
{
|
|
printk("machine restart\n");
|
|
|
|
if (!reboot_force)
|
|
machine_shutdown();
|
|
__machine_emergency_restart(0);
|
|
}
|
|
|
|
static void native_machine_halt(void)
|
|
{
|
|
/* stop other cpus and apics */
|
|
machine_shutdown();
|
|
|
|
/* stop this cpu */
|
|
stop_this_cpu(NULL);
|
|
}
|
|
|
|
static void native_machine_power_off(void)
|
|
{
|
|
if (pm_power_off) {
|
|
if (!reboot_force)
|
|
machine_shutdown();
|
|
pm_power_off();
|
|
}
|
|
}
|
|
|
|
struct machine_ops machine_ops = {
|
|
.power_off = native_machine_power_off,
|
|
.shutdown = native_machine_shutdown,
|
|
.emergency_restart = native_machine_emergency_restart,
|
|
.restart = native_machine_restart,
|
|
.halt = native_machine_halt,
|
|
#ifdef CONFIG_KEXEC
|
|
.crash_shutdown = native_machine_crash_shutdown,
|
|
#endif
|
|
};
|
|
|
|
void machine_power_off(void)
|
|
{
|
|
machine_ops.power_off();
|
|
}
|
|
|
|
void machine_shutdown(void)
|
|
{
|
|
machine_ops.shutdown();
|
|
}
|
|
|
|
void machine_emergency_restart(void)
|
|
{
|
|
__machine_emergency_restart(1);
|
|
}
|
|
|
|
void machine_restart(char *cmd)
|
|
{
|
|
machine_ops.restart(cmd);
|
|
}
|
|
|
|
void machine_halt(void)
|
|
{
|
|
machine_ops.halt();
|
|
}
|
|
|
|
#ifdef CONFIG_KEXEC
|
|
void machine_crash_shutdown(struct pt_regs *regs)
|
|
{
|
|
machine_ops.crash_shutdown(regs);
|
|
}
|
|
#endif
|
|
|
|
|
|
#if defined(CONFIG_SMP)
|
|
|
|
/* This keeps a track of which one is crashing cpu. */
|
|
static int crashing_cpu;
|
|
static nmi_shootdown_cb shootdown_callback;
|
|
|
|
static atomic_t waiting_for_crash_ipi;
|
|
|
|
static int crash_nmi_callback(struct notifier_block *self,
|
|
unsigned long val, void *data)
|
|
{
|
|
int cpu;
|
|
|
|
if (val != DIE_NMI_IPI)
|
|
return NOTIFY_OK;
|
|
|
|
cpu = raw_smp_processor_id();
|
|
|
|
/* Don't do anything if this handler is invoked on crashing cpu.
|
|
* Otherwise, system will completely hang. Crashing cpu can get
|
|
* an NMI if system was initially booted with nmi_watchdog parameter.
|
|
*/
|
|
if (cpu == crashing_cpu)
|
|
return NOTIFY_STOP;
|
|
local_irq_disable();
|
|
|
|
shootdown_callback(cpu, (struct die_args *)data);
|
|
|
|
atomic_dec(&waiting_for_crash_ipi);
|
|
/* Assume hlt works */
|
|
halt();
|
|
for (;;)
|
|
cpu_relax();
|
|
|
|
return 1;
|
|
}
|
|
|
|
static void smp_send_nmi_allbutself(void)
|
|
{
|
|
cpumask_t mask = cpu_online_map;
|
|
cpu_clear(safe_smp_processor_id(), mask);
|
|
if (!cpus_empty(mask))
|
|
send_IPI_mask(mask, NMI_VECTOR);
|
|
}
|
|
|
|
static struct notifier_block crash_nmi_nb = {
|
|
.notifier_call = crash_nmi_callback,
|
|
};
|
|
|
|
/* Halt all other CPUs, calling the specified function on each of them
|
|
*
|
|
* This function can be used to halt all other CPUs on crash
|
|
* or emergency reboot time. The function passed as parameter
|
|
* will be called inside a NMI handler on all CPUs.
|
|
*/
|
|
void nmi_shootdown_cpus(nmi_shootdown_cb callback)
|
|
{
|
|
unsigned long msecs;
|
|
local_irq_disable();
|
|
|
|
/* Make a note of crashing cpu. Will be used in NMI callback.*/
|
|
crashing_cpu = safe_smp_processor_id();
|
|
|
|
shootdown_callback = callback;
|
|
|
|
atomic_set(&waiting_for_crash_ipi, num_online_cpus() - 1);
|
|
/* Would it be better to replace the trap vector here? */
|
|
if (register_die_notifier(&crash_nmi_nb))
|
|
return; /* return what? */
|
|
/* Ensure the new callback function is set before sending
|
|
* out the NMI
|
|
*/
|
|
wmb();
|
|
|
|
smp_send_nmi_allbutself();
|
|
|
|
msecs = 1000; /* Wait at most a second for the other cpus to stop */
|
|
while ((atomic_read(&waiting_for_crash_ipi) > 0) && msecs) {
|
|
mdelay(1);
|
|
msecs--;
|
|
}
|
|
|
|
/* Leave the nmi callback set */
|
|
}
|
|
#else /* !CONFIG_SMP */
|
|
void nmi_shootdown_cpus(nmi_shootdown_cb callback)
|
|
{
|
|
/* No other CPUs to shoot down */
|
|
}
|
|
#endif
|