147 lines · 4.0 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0-only/* *  Copyright (C) 1996-2000 Russell King - Converted to ARM. *  Original Copyright (C) 1995  Linus Torvalds */#include <linux/cpu.h>#include <linux/delay.h>#include <linux/reboot.h> #include <asm/cacheflush.h>#include <asm/idmap.h>#include <asm/virt.h>#include <asm/system_misc.h> #include "reboot.h" typedef void (*phys_reset_t)(unsigned long, bool); /* * Function pointers to optional machine specific functions */void (*pm_power_off)(void);EXPORT_SYMBOL(pm_power_off); /* * A temporary stack to use for CPU reset. This is static so that we * don't clobber it with the identity mapping. When running with this * stack, any references to the current task *will not work* so you * should really do as little as possible before jumping to your reset * code. */static u64 soft_restart_stack[16]; static void __soft_restart(void *addr){	phys_reset_t phys_reset; 	/* Take out a flat memory mapping. */	setup_mm_for_reboot(); 	/* Clean and invalidate caches */	flush_cache_all(); 	/* Turn off caching */	cpu_proc_fin(); 	/* Push out any further dirty data, and ensure cache is empty */	flush_cache_all(); 	/* Switch to the identity mapping. */	phys_reset = (phys_reset_t)virt_to_idmap(cpu_reset); 	/* original stub should be restored by kvm */	phys_reset((unsigned long)addr, is_hyp_mode_available()); 	/* Should never get here. */	BUG();} void _soft_restart(unsigned long addr, bool disable_l2){	u64 *stack = soft_restart_stack + ARRAY_SIZE(soft_restart_stack); 	/* Disable interrupts first */	raw_local_irq_disable();	local_fiq_disable(); 	/* Disable the L2 if we're the last man standing. */	if (disable_l2)		outer_disable(); 	/* Change to the new stack and continue with the reset. */	call_with_stack(__soft_restart, (void *)addr, (void *)stack); 	/* Should never get here. */	BUG();} void soft_restart(unsigned long addr){	_soft_restart(addr, num_online_cpus() == 1);} /* * Called by kexec, immediately prior to machine_kexec(). * * This must completely disable all secondary CPUs; simply causing those CPUs * to execute e.g. a RAM-based pin loop is not sufficient. This allows the * kexec'd kernel to use any and all RAM as it sees fit, without having to * avoid any code or data used by any SW CPU pin loop. The CPU hotplug * functionality embodied in smp_shutdown_nonboot_cpus() to achieve this. */void machine_shutdown(void){	smp_shutdown_nonboot_cpus(reboot_cpu);} /* * Halting simply requires that the secondary CPUs stop performing any * activity (executing tasks, handling interrupts). smp_send_stop() * achieves this. */void machine_halt(void){	local_irq_disable();	smp_send_stop();	while (1);} /* * Power-off simply requires that the secondary CPUs stop performing any * activity (executing tasks, handling interrupts). smp_send_stop() * achieves this. When the system power is turned off, it will take all CPUs * with it. */void machine_power_off(void){	local_irq_disable();	smp_send_stop();	do_kernel_power_off();} /* * Restart requires that the secondary CPUs stop performing any activity * while the primary CPU resets the system. Systems with a single CPU can * use soft_restart() as their machine descriptor's .restart hook, since that * will cause the only available CPU to reset. Systems with multiple CPUs must * provide a HW restart implementation, to ensure that all CPUs reset at once. * This is required so that any code running after reset on the primary CPU * doesn't have to co-ordinate with other CPUs to ensure they aren't still * executing pre-reset code, and using RAM that the primary CPU's code wishes * to use. Implementing such co-ordination would be essentially impossible. */void machine_restart(char *cmd){	local_irq_disable();	smp_send_stop(); 	do_kernel_restart(cmd); 	/* Give a grace period for failure to restart of 1s */	mdelay(1000); 	/* Whoops - the platform was unable to reboot. Tell the user! */	printk("Reboot failed -- System halted\n");	while (1);}