1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright 2011 Calxeda, Inc.
4  */
5 
6 #include <linux/cpu_pm.h>
7 #include <linux/init.h>
8 #include <linux/psci.h>
9 #include <linux/suspend.h>
10 
11 #include <asm/suspend.h>
12 
13 #include <uapi/linux/psci.h>
14 
15 #include "core.h"
16 
17 #define HIGHBANK_SUSPEND_PARAM \
18 	((0 << PSCI_0_2_POWER_STATE_ID_SHIFT) | \
19 	 (1 << PSCI_0_2_POWER_STATE_AFFL_SHIFT) | \
20 	 (PSCI_POWER_STATE_TYPE_POWER_DOWN << PSCI_0_2_POWER_STATE_TYPE_SHIFT))
21 
highbank_suspend_finish(unsigned long val)22 static int highbank_suspend_finish(unsigned long val)
23 {
24 	return psci_ops.cpu_suspend(HIGHBANK_SUSPEND_PARAM, __pa(cpu_resume));
25 }
26 
highbank_pm_enter(suspend_state_t state)27 static int highbank_pm_enter(suspend_state_t state)
28 {
29 	cpu_pm_enter();
30 	cpu_cluster_pm_enter();
31 
32 	cpu_suspend(0, highbank_suspend_finish);
33 
34 	cpu_cluster_pm_exit();
35 	cpu_pm_exit();
36 
37 	return 0;
38 }
39 
40 static const struct platform_suspend_ops highbank_pm_ops = {
41 	.enter = highbank_pm_enter,
42 	.valid = suspend_valid_only_mem,
43 };
44 
highbank_pm_init(void)45 void __init highbank_pm_init(void)
46 {
47 	if (!psci_ops.cpu_suspend)
48 		return;
49 
50 	suspend_set_ops(&highbank_pm_ops);
51 }
52