@@ -5,11 +5,7 @@
#include <xen/lib.h>
#include <xen/smp.h>
#include <asm/platform.h>
-
-static void raw_machine_reset(void)
-{
- platform_reset();
-}
+#include <asm/psci.h>
static void noreturn halt_this_cpu(void *arg)
{
@@ -18,10 +14,23 @@ static void noreturn halt_this_cpu(void *arg)
void machine_halt(void)
{
+ int timeout = 10;
+
watchdog_disable();
console_start_sync();
local_irq_enable();
smp_call_function(halt_this_cpu, NULL, 0);
+ local_irq_disable();
+
+ /* Wait at most another 10ms for all other CPUs to go offline. */
+ while ( (num_online_cpus() > 1) && (timeout-- > 0) )
+ mdelay(1);
+
+ /* This is mainly for PSCI-0.2, which does not return if success. */
+ call_psci_system_off();
+
+ /* Alternative halt procedure */
+ platform_poweroff();
halt_this_cpu(NULL);
}
@@ -39,9 +48,13 @@ void machine_restart(unsigned int delay_millisecs)
while ( (num_online_cpus() > 1) && (timeout-- > 0) )
mdelay(1);
+ /* This is mainly for PSCI-0.2, which does not return if success. */
+ call_psci_system_reset();
+
+ /* Alternative reset procedure */
while ( 1 )
{
- raw_machine_reset();
+ platform_reset();
mdelay(100);
}
}