|  | // 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); | 
|  | } |