| /* | |
| * Copyright (C) 1996-2000 Russell King - Converted to ARM. | |
| * Original Copyright (C) 1995 Linus Torvalds | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License version 2 as | |
| * published by the Free Software Foundation. | |
| */ | |
| #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 "reboot.h" | |
| typedef void (*phys_reset_t)(unsigned long, bool); | |
| /* | |
| * Function pointers to optional machine specific functions | |
| */ | |
| void (*arm_pm_restart)(enum reboot_mode reboot_mode, const char *cmd); | |
| 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 disable_nonboot_cpus() to achieve this. | |
| */ | |
| void machine_shutdown(void) | |
| { | |
| disable_nonboot_cpus(); | |
| } | |
| /* | |
| * 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(); | |
| if (pm_power_off) | |
| pm_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(); | |
| if (arm_pm_restart) | |
| arm_pm_restart(reboot_mode, cmd); | |
| else | |
| 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); | |
| } |