1d405a98cSShreyas B. Prabhu /*
2d405a98cSShreyas B. Prabhu  * PowerNV cpuidle code
3d405a98cSShreyas B. Prabhu  *
4d405a98cSShreyas B. Prabhu  * Copyright 2015 IBM Corp.
5d405a98cSShreyas B. Prabhu  *
6d405a98cSShreyas B. Prabhu  * This program is free software; you can redistribute it and/or
7d405a98cSShreyas B. Prabhu  * modify it under the terms of the GNU General Public License
8d405a98cSShreyas B. Prabhu  * as published by the Free Software Foundation; either version
9d405a98cSShreyas B. Prabhu  * 2 of the License, or (at your option) any later version.
10d405a98cSShreyas B. Prabhu  */
11d405a98cSShreyas B. Prabhu 
12d405a98cSShreyas B. Prabhu #include <linux/types.h>
13d405a98cSShreyas B. Prabhu #include <linux/mm.h>
14d405a98cSShreyas B. Prabhu #include <linux/slab.h>
15d405a98cSShreyas B. Prabhu #include <linux/of.h>
165703d2f4SShreyas B. Prabhu #include <linux/device.h>
175703d2f4SShreyas B. Prabhu #include <linux/cpu.h>
18d405a98cSShreyas B. Prabhu 
19d405a98cSShreyas B. Prabhu #include <asm/firmware.h>
204bece972SMichael Ellerman #include <asm/machdep.h>
21d405a98cSShreyas B. Prabhu #include <asm/opal.h>
22d405a98cSShreyas B. Prabhu #include <asm/cputhreads.h>
23d405a98cSShreyas B. Prabhu #include <asm/cpuidle.h>
24d405a98cSShreyas B. Prabhu #include <asm/code-patching.h>
25d405a98cSShreyas B. Prabhu #include <asm/smp.h>
262201f994SNicholas Piggin #include <asm/runlatch.h>
27d405a98cSShreyas B. Prabhu 
28d405a98cSShreyas B. Prabhu #include "powernv.h"
29d405a98cSShreyas B. Prabhu #include "subcore.h"
30d405a98cSShreyas B. Prabhu 
31bcef83a0SShreyas B. Prabhu /* Power ISA 3.0 allows for stop states 0x0 - 0xF */
32bcef83a0SShreyas B. Prabhu #define MAX_STOP_STATE	0xF
33bcef83a0SShreyas B. Prabhu 
341e1601b3SAkshay Adiga #define P9_STOP_SPR_MSR 2000
351e1601b3SAkshay Adiga #define P9_STOP_SPR_PSSCR      855
361e1601b3SAkshay Adiga 
37d405a98cSShreyas B. Prabhu static u32 supported_cpuidle_states;
38d405a98cSShreyas B. Prabhu 
391e1601b3SAkshay Adiga /*
401e1601b3SAkshay Adiga  * The default stop state that will be used by ppc_md.power_save
411e1601b3SAkshay Adiga  * function on platforms that support stop instruction.
421e1601b3SAkshay Adiga  */
431e1601b3SAkshay Adiga static u64 pnv_default_stop_val;
441e1601b3SAkshay Adiga static u64 pnv_default_stop_mask;
451e1601b3SAkshay Adiga static bool default_stop_found;
461e1601b3SAkshay Adiga 
471e1601b3SAkshay Adiga /*
481e1601b3SAkshay Adiga  * First deep stop state. Used to figure out when to save/restore
491e1601b3SAkshay Adiga  * hypervisor context.
501e1601b3SAkshay Adiga  */
511e1601b3SAkshay Adiga u64 pnv_first_deep_stop_state = MAX_STOP_STATE;
521e1601b3SAkshay Adiga 
531e1601b3SAkshay Adiga /*
541e1601b3SAkshay Adiga  * psscr value and mask of the deepest stop idle state.
551e1601b3SAkshay Adiga  * Used when a cpu is offlined.
561e1601b3SAkshay Adiga  */
571e1601b3SAkshay Adiga static u64 pnv_deepest_stop_psscr_val;
581e1601b3SAkshay Adiga static u64 pnv_deepest_stop_psscr_mask;
59785a12afSGautham R. Shenoy static u64 pnv_deepest_stop_flag;
601e1601b3SAkshay Adiga static bool deepest_stop_found;
611e1601b3SAkshay Adiga 
62bcef83a0SShreyas B. Prabhu static int pnv_save_sprs_for_deep_states(void)
63d405a98cSShreyas B. Prabhu {
64d405a98cSShreyas B. Prabhu 	int cpu;
65d405a98cSShreyas B. Prabhu 	int rc;
66d405a98cSShreyas B. Prabhu 
67d405a98cSShreyas B. Prabhu 	/*
68446957baSAdam Buchbinder 	 * hid0, hid1, hid4, hid5, hmeer and lpcr values are symmetric across
69d405a98cSShreyas B. Prabhu 	 * all cpus at boot. Get these reg values of current cpu and use the
70446957baSAdam Buchbinder 	 * same across all cpus.
71d405a98cSShreyas B. Prabhu 	 */
7224be85a2SGautham R. Shenoy 	uint64_t lpcr_val = mfspr(SPRN_LPCR);
73d405a98cSShreyas B. Prabhu 	uint64_t hid0_val = mfspr(SPRN_HID0);
74d405a98cSShreyas B. Prabhu 	uint64_t hid1_val = mfspr(SPRN_HID1);
75d405a98cSShreyas B. Prabhu 	uint64_t hid4_val = mfspr(SPRN_HID4);
76d405a98cSShreyas B. Prabhu 	uint64_t hid5_val = mfspr(SPRN_HID5);
77d405a98cSShreyas B. Prabhu 	uint64_t hmeer_val = mfspr(SPRN_HMEER);
781e1601b3SAkshay Adiga 	uint64_t msr_val = MSR_IDLE;
791e1601b3SAkshay Adiga 	uint64_t psscr_val = pnv_deepest_stop_psscr_val;
80d405a98cSShreyas B. Prabhu 
81d405a98cSShreyas B. Prabhu 	for_each_possible_cpu(cpu) {
82d405a98cSShreyas B. Prabhu 		uint64_t pir = get_hard_smp_processor_id(cpu);
83d2e60075SNicholas Piggin 		uint64_t hsprg0_val = (uint64_t)paca_ptrs[cpu];
84d405a98cSShreyas B. Prabhu 
85d405a98cSShreyas B. Prabhu 		rc = opal_slw_set_reg(pir, SPRN_HSPRG0, hsprg0_val);
86d405a98cSShreyas B. Prabhu 		if (rc != 0)
87d405a98cSShreyas B. Prabhu 			return rc;
88d405a98cSShreyas B. Prabhu 
89d405a98cSShreyas B. Prabhu 		rc = opal_slw_set_reg(pir, SPRN_LPCR, lpcr_val);
90d405a98cSShreyas B. Prabhu 		if (rc != 0)
91d405a98cSShreyas B. Prabhu 			return rc;
92d405a98cSShreyas B. Prabhu 
931e1601b3SAkshay Adiga 		if (cpu_has_feature(CPU_FTR_ARCH_300)) {
941e1601b3SAkshay Adiga 			rc = opal_slw_set_reg(pir, P9_STOP_SPR_MSR, msr_val);
951e1601b3SAkshay Adiga 			if (rc)
961e1601b3SAkshay Adiga 				return rc;
971e1601b3SAkshay Adiga 
981e1601b3SAkshay Adiga 			rc = opal_slw_set_reg(pir,
991e1601b3SAkshay Adiga 					      P9_STOP_SPR_PSSCR, psscr_val);
1001e1601b3SAkshay Adiga 
1011e1601b3SAkshay Adiga 			if (rc)
1021e1601b3SAkshay Adiga 				return rc;
1031e1601b3SAkshay Adiga 		}
1041e1601b3SAkshay Adiga 
105d405a98cSShreyas B. Prabhu 		/* HIDs are per core registers */
106d405a98cSShreyas B. Prabhu 		if (cpu_thread_in_core(cpu) == 0) {
107d405a98cSShreyas B. Prabhu 
108d405a98cSShreyas B. Prabhu 			rc = opal_slw_set_reg(pir, SPRN_HMEER, hmeer_val);
109d405a98cSShreyas B. Prabhu 			if (rc != 0)
110d405a98cSShreyas B. Prabhu 				return rc;
111d405a98cSShreyas B. Prabhu 
112d405a98cSShreyas B. Prabhu 			rc = opal_slw_set_reg(pir, SPRN_HID0, hid0_val);
113d405a98cSShreyas B. Prabhu 			if (rc != 0)
114d405a98cSShreyas B. Prabhu 				return rc;
115d405a98cSShreyas B. Prabhu 
1161e1601b3SAkshay Adiga 			/* Only p8 needs to set extra HID regiters */
1171e1601b3SAkshay Adiga 			if (!cpu_has_feature(CPU_FTR_ARCH_300)) {
1181e1601b3SAkshay Adiga 
119d405a98cSShreyas B. Prabhu 				rc = opal_slw_set_reg(pir, SPRN_HID1, hid1_val);
120d405a98cSShreyas B. Prabhu 				if (rc != 0)
121d405a98cSShreyas B. Prabhu 					return rc;
122d405a98cSShreyas B. Prabhu 
123d405a98cSShreyas B. Prabhu 				rc = opal_slw_set_reg(pir, SPRN_HID4, hid4_val);
124d405a98cSShreyas B. Prabhu 				if (rc != 0)
125d405a98cSShreyas B. Prabhu 					return rc;
126d405a98cSShreyas B. Prabhu 
127d405a98cSShreyas B. Prabhu 				rc = opal_slw_set_reg(pir, SPRN_HID5, hid5_val);
128d405a98cSShreyas B. Prabhu 				if (rc != 0)
129d405a98cSShreyas B. Prabhu 					return rc;
130d405a98cSShreyas B. Prabhu 			}
131d405a98cSShreyas B. Prabhu 		}
1321e1601b3SAkshay Adiga 	}
133d405a98cSShreyas B. Prabhu 
134d405a98cSShreyas B. Prabhu 	return 0;
135d405a98cSShreyas B. Prabhu }
136d405a98cSShreyas B. Prabhu 
137d405a98cSShreyas B. Prabhu static void pnv_alloc_idle_core_states(void)
138d405a98cSShreyas B. Prabhu {
139d405a98cSShreyas B. Prabhu 	int i, j;
140d405a98cSShreyas B. Prabhu 	int nr_cores = cpu_nr_cores();
141d405a98cSShreyas B. Prabhu 	u32 *core_idle_state;
142d405a98cSShreyas B. Prabhu 
143d405a98cSShreyas B. Prabhu 	/*
1445f221c3cSGautham R. Shenoy 	 * core_idle_state - The lower 8 bits track the idle state of
1455f221c3cSGautham R. Shenoy 	 * each thread of the core.
1465f221c3cSGautham R. Shenoy 	 *
1475f221c3cSGautham R. Shenoy 	 * The most significant bit is the lock bit.
1485f221c3cSGautham R. Shenoy 	 *
1495f221c3cSGautham R. Shenoy 	 * Initially all the bits corresponding to threads_per_core
1505f221c3cSGautham R. Shenoy 	 * are set. They are cleared when the thread enters deep idle
1515f221c3cSGautham R. Shenoy 	 * state like sleep and winkle/stop.
1525f221c3cSGautham R. Shenoy 	 *
1535f221c3cSGautham R. Shenoy 	 * Initially the lock bit is cleared.  The lock bit has 2
1545f221c3cSGautham R. Shenoy 	 * purposes:
1555f221c3cSGautham R. Shenoy 	 * 	a. While the first thread in the core waking up from
1565f221c3cSGautham R. Shenoy 	 * 	   idle is restoring core state, it prevents other
1575f221c3cSGautham R. Shenoy 	 * 	   threads in the core from switching to process
1585f221c3cSGautham R. Shenoy 	 * 	   context.
1595f221c3cSGautham R. Shenoy 	 * 	b. While the last thread in the core is saving the
1605f221c3cSGautham R. Shenoy 	 *	   core state, it prevents a different thread from
1615f221c3cSGautham R. Shenoy 	 *	   waking up.
162d405a98cSShreyas B. Prabhu 	 */
163d405a98cSShreyas B. Prabhu 	for (i = 0; i < nr_cores; i++) {
164d405a98cSShreyas B. Prabhu 		int first_cpu = i * threads_per_core;
165d405a98cSShreyas B. Prabhu 		int node = cpu_to_node(first_cpu);
16617ed4c8fSGautham R. Shenoy 		size_t paca_ptr_array_size;
167d405a98cSShreyas B. Prabhu 
168d405a98cSShreyas B. Prabhu 		core_idle_state = kmalloc_node(sizeof(u32), GFP_KERNEL, node);
1695f221c3cSGautham R. Shenoy 		*core_idle_state = (1 << threads_per_core) - 1;
17017ed4c8fSGautham R. Shenoy 		paca_ptr_array_size = (threads_per_core *
17117ed4c8fSGautham R. Shenoy 				       sizeof(struct paca_struct *));
172d405a98cSShreyas B. Prabhu 
173d405a98cSShreyas B. Prabhu 		for (j = 0; j < threads_per_core; j++) {
174d405a98cSShreyas B. Prabhu 			int cpu = first_cpu + j;
175d405a98cSShreyas B. Prabhu 
176d2e60075SNicholas Piggin 			paca_ptrs[cpu]->core_idle_state_ptr = core_idle_state;
177d2e60075SNicholas Piggin 			paca_ptrs[cpu]->thread_idle_state = PNV_THREAD_RUNNING;
178d2e60075SNicholas Piggin 			paca_ptrs[cpu]->thread_mask = 1 << j;
17917ed4c8fSGautham R. Shenoy 			if (!cpu_has_feature(CPU_FTR_POWER9_DD1))
18017ed4c8fSGautham R. Shenoy 				continue;
181d2e60075SNicholas Piggin 			paca_ptrs[cpu]->thread_sibling_pacas =
18217ed4c8fSGautham R. Shenoy 				kmalloc_node(paca_ptr_array_size,
18317ed4c8fSGautham R. Shenoy 					     GFP_KERNEL, node);
184d405a98cSShreyas B. Prabhu 		}
185d405a98cSShreyas B. Prabhu 	}
186d405a98cSShreyas B. Prabhu 
187d405a98cSShreyas B. Prabhu 	update_subcore_sibling_mask();
188d405a98cSShreyas B. Prabhu 
189785a12afSGautham R. Shenoy 	if (supported_cpuidle_states & OPAL_PM_LOSE_FULL_CONTEXT) {
190785a12afSGautham R. Shenoy 		int rc = pnv_save_sprs_for_deep_states();
191785a12afSGautham R. Shenoy 
192785a12afSGautham R. Shenoy 		if (likely(!rc))
193785a12afSGautham R. Shenoy 			return;
194785a12afSGautham R. Shenoy 
195785a12afSGautham R. Shenoy 		/*
196785a12afSGautham R. Shenoy 		 * The stop-api is unable to restore hypervisor
197785a12afSGautham R. Shenoy 		 * resources on wakeup from platform idle states which
198785a12afSGautham R. Shenoy 		 * lose full context. So disable such states.
199785a12afSGautham R. Shenoy 		 */
200785a12afSGautham R. Shenoy 		supported_cpuidle_states &= ~OPAL_PM_LOSE_FULL_CONTEXT;
201785a12afSGautham R. Shenoy 		pr_warn("cpuidle-powernv: Disabling idle states that lose full context\n");
202785a12afSGautham R. Shenoy 		pr_warn("cpuidle-powernv: Idle power-savings, CPU-Hotplug affected\n");
203785a12afSGautham R. Shenoy 
204785a12afSGautham R. Shenoy 		if (cpu_has_feature(CPU_FTR_ARCH_300) &&
205785a12afSGautham R. Shenoy 		    (pnv_deepest_stop_flag & OPAL_PM_LOSE_FULL_CONTEXT)) {
206785a12afSGautham R. Shenoy 			/*
207785a12afSGautham R. Shenoy 			 * Use the default stop state for CPU-Hotplug
208785a12afSGautham R. Shenoy 			 * if available.
209785a12afSGautham R. Shenoy 			 */
210785a12afSGautham R. Shenoy 			if (default_stop_found) {
211785a12afSGautham R. Shenoy 				pnv_deepest_stop_psscr_val =
212785a12afSGautham R. Shenoy 					pnv_default_stop_val;
213785a12afSGautham R. Shenoy 				pnv_deepest_stop_psscr_mask =
214785a12afSGautham R. Shenoy 					pnv_default_stop_mask;
215785a12afSGautham R. Shenoy 				pr_warn("cpuidle-powernv: Offlined CPUs will stop with psscr = 0x%016llx\n",
216785a12afSGautham R. Shenoy 					pnv_deepest_stop_psscr_val);
217785a12afSGautham R. Shenoy 			} else { /* Fallback to snooze loop for CPU-Hotplug */
218785a12afSGautham R. Shenoy 				deepest_stop_found = false;
219785a12afSGautham R. Shenoy 				pr_warn("cpuidle-powernv: Offlined CPUs will busy wait\n");
220785a12afSGautham R. Shenoy 			}
221785a12afSGautham R. Shenoy 		}
222785a12afSGautham R. Shenoy 	}
223d405a98cSShreyas B. Prabhu }
224d405a98cSShreyas B. Prabhu 
225d405a98cSShreyas B. Prabhu u32 pnv_get_supported_cpuidle_states(void)
226d405a98cSShreyas B. Prabhu {
227d405a98cSShreyas B. Prabhu 	return supported_cpuidle_states;
228d405a98cSShreyas B. Prabhu }
229d405a98cSShreyas B. Prabhu EXPORT_SYMBOL_GPL(pnv_get_supported_cpuidle_states);
230d405a98cSShreyas B. Prabhu 
2315703d2f4SShreyas B. Prabhu static void pnv_fastsleep_workaround_apply(void *info)
2325703d2f4SShreyas B. Prabhu 
2335703d2f4SShreyas B. Prabhu {
2345703d2f4SShreyas B. Prabhu 	int rc;
2355703d2f4SShreyas B. Prabhu 	int *err = info;
2365703d2f4SShreyas B. Prabhu 
2375703d2f4SShreyas B. Prabhu 	rc = opal_config_cpu_idle_state(OPAL_CONFIG_IDLE_FASTSLEEP,
2385703d2f4SShreyas B. Prabhu 					OPAL_CONFIG_IDLE_APPLY);
2395703d2f4SShreyas B. Prabhu 	if (rc)
2405703d2f4SShreyas B. Prabhu 		*err = 1;
2415703d2f4SShreyas B. Prabhu }
2425703d2f4SShreyas B. Prabhu 
2435703d2f4SShreyas B. Prabhu /*
2445703d2f4SShreyas B. Prabhu  * Used to store fastsleep workaround state
2455703d2f4SShreyas B. Prabhu  * 0 - Workaround applied/undone at fastsleep entry/exit path (Default)
2465703d2f4SShreyas B. Prabhu  * 1 - Workaround applied once, never undone.
2475703d2f4SShreyas B. Prabhu  */
2485703d2f4SShreyas B. Prabhu static u8 fastsleep_workaround_applyonce;
2495703d2f4SShreyas B. Prabhu 
2505703d2f4SShreyas B. Prabhu static ssize_t show_fastsleep_workaround_applyonce(struct device *dev,
2515703d2f4SShreyas B. Prabhu 		struct device_attribute *attr, char *buf)
2525703d2f4SShreyas B. Prabhu {
2535703d2f4SShreyas B. Prabhu 	return sprintf(buf, "%u\n", fastsleep_workaround_applyonce);
2545703d2f4SShreyas B. Prabhu }
2555703d2f4SShreyas B. Prabhu 
2565703d2f4SShreyas B. Prabhu static ssize_t store_fastsleep_workaround_applyonce(struct device *dev,
2575703d2f4SShreyas B. Prabhu 		struct device_attribute *attr, const char *buf,
2585703d2f4SShreyas B. Prabhu 		size_t count)
2595703d2f4SShreyas B. Prabhu {
2605703d2f4SShreyas B. Prabhu 	cpumask_t primary_thread_mask;
2615703d2f4SShreyas B. Prabhu 	int err;
2625703d2f4SShreyas B. Prabhu 	u8 val;
2635703d2f4SShreyas B. Prabhu 
2645703d2f4SShreyas B. Prabhu 	if (kstrtou8(buf, 0, &val) || val != 1)
2655703d2f4SShreyas B. Prabhu 		return -EINVAL;
2665703d2f4SShreyas B. Prabhu 
2675703d2f4SShreyas B. Prabhu 	if (fastsleep_workaround_applyonce == 1)
2685703d2f4SShreyas B. Prabhu 		return count;
2695703d2f4SShreyas B. Prabhu 
2705703d2f4SShreyas B. Prabhu 	/*
2715703d2f4SShreyas B. Prabhu 	 * fastsleep_workaround_applyonce = 1 implies
2725703d2f4SShreyas B. Prabhu 	 * fastsleep workaround needs to be left in 'applied' state on all
2735703d2f4SShreyas B. Prabhu 	 * the cores. Do this by-
2745703d2f4SShreyas B. Prabhu 	 * 1. Patching out the call to 'undo' workaround in fastsleep exit path
2755703d2f4SShreyas B. Prabhu 	 * 2. Sending ipi to all the cores which have at least one online thread
2765703d2f4SShreyas B. Prabhu 	 * 3. Patching out the call to 'apply' workaround in fastsleep entry
2775703d2f4SShreyas B. Prabhu 	 * path
2785703d2f4SShreyas B. Prabhu 	 * There is no need to send ipi to cores which have all threads
2795703d2f4SShreyas B. Prabhu 	 * offlined, as last thread of the core entering fastsleep or deeper
2805703d2f4SShreyas B. Prabhu 	 * state would have applied workaround.
2815703d2f4SShreyas B. Prabhu 	 */
2825703d2f4SShreyas B. Prabhu 	err = patch_instruction(
2835703d2f4SShreyas B. Prabhu 		(unsigned int *)pnv_fastsleep_workaround_at_exit,
2845703d2f4SShreyas B. Prabhu 		PPC_INST_NOP);
2855703d2f4SShreyas B. Prabhu 	if (err) {
2865703d2f4SShreyas B. Prabhu 		pr_err("fastsleep_workaround_applyonce change failed while patching pnv_fastsleep_workaround_at_exit");
2875703d2f4SShreyas B. Prabhu 		goto fail;
2885703d2f4SShreyas B. Prabhu 	}
2895703d2f4SShreyas B. Prabhu 
2905703d2f4SShreyas B. Prabhu 	get_online_cpus();
2915703d2f4SShreyas B. Prabhu 	primary_thread_mask = cpu_online_cores_map();
2925703d2f4SShreyas B. Prabhu 	on_each_cpu_mask(&primary_thread_mask,
2935703d2f4SShreyas B. Prabhu 				pnv_fastsleep_workaround_apply,
2945703d2f4SShreyas B. Prabhu 				&err, 1);
2955703d2f4SShreyas B. Prabhu 	put_online_cpus();
2965703d2f4SShreyas B. Prabhu 	if (err) {
2975703d2f4SShreyas B. Prabhu 		pr_err("fastsleep_workaround_applyonce change failed while running pnv_fastsleep_workaround_apply");
2985703d2f4SShreyas B. Prabhu 		goto fail;
2995703d2f4SShreyas B. Prabhu 	}
3005703d2f4SShreyas B. Prabhu 
3015703d2f4SShreyas B. Prabhu 	err = patch_instruction(
3025703d2f4SShreyas B. Prabhu 		(unsigned int *)pnv_fastsleep_workaround_at_entry,
3035703d2f4SShreyas B. Prabhu 		PPC_INST_NOP);
3045703d2f4SShreyas B. Prabhu 	if (err) {
3055703d2f4SShreyas B. Prabhu 		pr_err("fastsleep_workaround_applyonce change failed while patching pnv_fastsleep_workaround_at_entry");
3065703d2f4SShreyas B. Prabhu 		goto fail;
3075703d2f4SShreyas B. Prabhu 	}
3085703d2f4SShreyas B. Prabhu 
3095703d2f4SShreyas B. Prabhu 	fastsleep_workaround_applyonce = 1;
3105703d2f4SShreyas B. Prabhu 
3115703d2f4SShreyas B. Prabhu 	return count;
3125703d2f4SShreyas B. Prabhu fail:
3135703d2f4SShreyas B. Prabhu 	return -EIO;
3145703d2f4SShreyas B. Prabhu }
3155703d2f4SShreyas B. Prabhu 
3165703d2f4SShreyas B. Prabhu static DEVICE_ATTR(fastsleep_workaround_applyonce, 0600,
3175703d2f4SShreyas B. Prabhu 			show_fastsleep_workaround_applyonce,
3185703d2f4SShreyas B. Prabhu 			store_fastsleep_workaround_applyonce);
3195703d2f4SShreyas B. Prabhu 
3202201f994SNicholas Piggin static unsigned long __power7_idle_type(unsigned long type)
3212201f994SNicholas Piggin {
3222201f994SNicholas Piggin 	unsigned long srr1;
3232201f994SNicholas Piggin 
3242201f994SNicholas Piggin 	if (!prep_irq_for_idle_irqsoff())
3252201f994SNicholas Piggin 		return 0;
3262201f994SNicholas Piggin 
32740d24343SNicholas Piggin 	__ppc64_runlatch_off();
3282201f994SNicholas Piggin 	srr1 = power7_idle_insn(type);
32940d24343SNicholas Piggin 	__ppc64_runlatch_on();
3302201f994SNicholas Piggin 
3312201f994SNicholas Piggin 	fini_irq_for_idle_irqsoff();
3322201f994SNicholas Piggin 
3332201f994SNicholas Piggin 	return srr1;
3342201f994SNicholas Piggin }
3352201f994SNicholas Piggin 
3362201f994SNicholas Piggin void power7_idle_type(unsigned long type)
3372201f994SNicholas Piggin {
338771d4304SNicholas Piggin 	unsigned long srr1;
339771d4304SNicholas Piggin 
340771d4304SNicholas Piggin 	srr1 = __power7_idle_type(type);
341771d4304SNicholas Piggin 	irq_set_pending_from_srr1(srr1);
3422201f994SNicholas Piggin }
3432201f994SNicholas Piggin 
3442201f994SNicholas Piggin void power7_idle(void)
3452201f994SNicholas Piggin {
3462201f994SNicholas Piggin 	if (!powersave_nap)
3472201f994SNicholas Piggin 		return;
3482201f994SNicholas Piggin 
3492201f994SNicholas Piggin 	power7_idle_type(PNV_THREAD_NAP);
3502201f994SNicholas Piggin }
3512201f994SNicholas Piggin 
3522201f994SNicholas Piggin static unsigned long __power9_idle_type(unsigned long stop_psscr_val,
3532201f994SNicholas Piggin 				      unsigned long stop_psscr_mask)
3542201f994SNicholas Piggin {
3552201f994SNicholas Piggin 	unsigned long psscr;
3562201f994SNicholas Piggin 	unsigned long srr1;
3572201f994SNicholas Piggin 
3582201f994SNicholas Piggin 	if (!prep_irq_for_idle_irqsoff())
3592201f994SNicholas Piggin 		return 0;
3602201f994SNicholas Piggin 
3612201f994SNicholas Piggin 	psscr = mfspr(SPRN_PSSCR);
3622201f994SNicholas Piggin 	psscr = (psscr & ~stop_psscr_mask) | stop_psscr_val;
3632201f994SNicholas Piggin 
36440d24343SNicholas Piggin 	__ppc64_runlatch_off();
3652201f994SNicholas Piggin 	srr1 = power9_idle_stop(psscr);
36640d24343SNicholas Piggin 	__ppc64_runlatch_on();
3672201f994SNicholas Piggin 
3682201f994SNicholas Piggin 	fini_irq_for_idle_irqsoff();
3692201f994SNicholas Piggin 
3702201f994SNicholas Piggin 	return srr1;
3712201f994SNicholas Piggin }
3722201f994SNicholas Piggin 
3732201f994SNicholas Piggin void power9_idle_type(unsigned long stop_psscr_val,
3742201f994SNicholas Piggin 				      unsigned long stop_psscr_mask)
3752201f994SNicholas Piggin {
376771d4304SNicholas Piggin 	unsigned long srr1;
377771d4304SNicholas Piggin 
378771d4304SNicholas Piggin 	srr1 = __power9_idle_type(stop_psscr_val, stop_psscr_mask);
379771d4304SNicholas Piggin 	irq_set_pending_from_srr1(srr1);
3802201f994SNicholas Piggin }
3812201f994SNicholas Piggin 
38209206b60SGautham R. Shenoy /*
383bcef83a0SShreyas B. Prabhu  * Used for ppc_md.power_save which needs a function with no parameters
384bcef83a0SShreyas B. Prabhu  */
3852201f994SNicholas Piggin void power9_idle(void)
386d405a98cSShreyas B. Prabhu {
3872201f994SNicholas Piggin 	power9_idle_type(pnv_default_stop_val, pnv_default_stop_mask);
388bcef83a0SShreyas B. Prabhu }
38909206b60SGautham R. Shenoy 
39067d20418SNicholas Piggin #ifdef CONFIG_HOTPLUG_CPU
39124be85a2SGautham R. Shenoy static void pnv_program_cpu_hotplug_lpcr(unsigned int cpu, u64 lpcr_val)
39224be85a2SGautham R. Shenoy {
39324be85a2SGautham R. Shenoy 	u64 pir = get_hard_smp_processor_id(cpu);
39424be85a2SGautham R. Shenoy 
39524be85a2SGautham R. Shenoy 	mtspr(SPRN_LPCR, lpcr_val);
3965d298baaSGautham R. Shenoy 
3975d298baaSGautham R. Shenoy 	/*
3985d298baaSGautham R. Shenoy 	 * Program the LPCR via stop-api only if the deepest stop state
3995d298baaSGautham R. Shenoy 	 * can lose hypervisor context.
4005d298baaSGautham R. Shenoy 	 */
4015d298baaSGautham R. Shenoy 	if (supported_cpuidle_states & OPAL_PM_LOSE_FULL_CONTEXT)
40224be85a2SGautham R. Shenoy 		opal_slw_set_reg(pir, SPRN_LPCR, lpcr_val);
40324be85a2SGautham R. Shenoy }
40424be85a2SGautham R. Shenoy 
405c0691f9dSShreyas B. Prabhu /*
406a7cd88daSGautham R. Shenoy  * pnv_cpu_offline: A function that puts the CPU into the deepest
407a7cd88daSGautham R. Shenoy  * available platform idle state on a CPU-Offline.
4082525db04SNicholas Piggin  * interrupts hard disabled and no lazy irq pending.
409a7cd88daSGautham R. Shenoy  */
410a7cd88daSGautham R. Shenoy unsigned long pnv_cpu_offline(unsigned int cpu)
411a7cd88daSGautham R. Shenoy {
412a7cd88daSGautham R. Shenoy 	unsigned long srr1;
413a7cd88daSGautham R. Shenoy 	u32 idle_states = pnv_get_supported_cpuidle_states();
41424be85a2SGautham R. Shenoy 	u64 lpcr_val;
41524be85a2SGautham R. Shenoy 
41624be85a2SGautham R. Shenoy 	/*
41724be85a2SGautham R. Shenoy 	 * We don't want to take decrementer interrupts while we are
41824be85a2SGautham R. Shenoy 	 * offline, so clear LPCR:PECE1. We keep PECE2 (and
41924be85a2SGautham R. Shenoy 	 * LPCR_PECE_HVEE on P9) enabled as to let IPIs in.
42024be85a2SGautham R. Shenoy 	 *
42124be85a2SGautham R. Shenoy 	 * If the CPU gets woken up by a special wakeup, ensure that
42224be85a2SGautham R. Shenoy 	 * the SLW engine sets LPCR with decrementer bit cleared, else
42324be85a2SGautham R. Shenoy 	 * the CPU will come back to the kernel due to a spurious
42424be85a2SGautham R. Shenoy 	 * wakeup.
42524be85a2SGautham R. Shenoy 	 */
42624be85a2SGautham R. Shenoy 	lpcr_val = mfspr(SPRN_LPCR) & ~(u64)LPCR_PECE1;
42724be85a2SGautham R. Shenoy 	pnv_program_cpu_hotplug_lpcr(cpu, lpcr_val);
428a7cd88daSGautham R. Shenoy 
42940d24343SNicholas Piggin 	__ppc64_runlatch_off();
4302525db04SNicholas Piggin 
431f3b3f284SGautham R. Shenoy 	if (cpu_has_feature(CPU_FTR_ARCH_300) && deepest_stop_found) {
4322525db04SNicholas Piggin 		unsigned long psscr;
4332525db04SNicholas Piggin 
4342525db04SNicholas Piggin 		psscr = mfspr(SPRN_PSSCR);
4352525db04SNicholas Piggin 		psscr = (psscr & ~pnv_deepest_stop_psscr_mask) |
4362525db04SNicholas Piggin 						pnv_deepest_stop_psscr_val;
4372525db04SNicholas Piggin 		srr1 = power9_idle_stop(psscr);
4382525db04SNicholas Piggin 
439785a12afSGautham R. Shenoy 	} else if ((idle_states & OPAL_PM_WINKLE_ENABLED) &&
440785a12afSGautham R. Shenoy 		   (idle_states & OPAL_PM_LOSE_FULL_CONTEXT)) {
4412525db04SNicholas Piggin 		srr1 = power7_idle_insn(PNV_THREAD_WINKLE);
442a7cd88daSGautham R. Shenoy 	} else if ((idle_states & OPAL_PM_SLEEP_ENABLED) ||
443a7cd88daSGautham R. Shenoy 		   (idle_states & OPAL_PM_SLEEP_ENABLED_ER1)) {
4442525db04SNicholas Piggin 		srr1 = power7_idle_insn(PNV_THREAD_SLEEP);
44590061231SGautham R. Shenoy 	} else if (idle_states & OPAL_PM_NAP_ENABLED) {
4462525db04SNicholas Piggin 		srr1 = power7_idle_insn(PNV_THREAD_NAP);
44790061231SGautham R. Shenoy 	} else {
44890061231SGautham R. Shenoy 		/* This is the fallback method. We emulate snooze */
44990061231SGautham R. Shenoy 		while (!generic_check_cpu_restart(cpu)) {
45090061231SGautham R. Shenoy 			HMT_low();
45190061231SGautham R. Shenoy 			HMT_very_low();
45290061231SGautham R. Shenoy 		}
45390061231SGautham R. Shenoy 		srr1 = 0;
45490061231SGautham R. Shenoy 		HMT_medium();
455a7cd88daSGautham R. Shenoy 	}
456a7cd88daSGautham R. Shenoy 
45740d24343SNicholas Piggin 	__ppc64_runlatch_on();
4582525db04SNicholas Piggin 
45924be85a2SGautham R. Shenoy 	/*
46024be85a2SGautham R. Shenoy 	 * Re-enable decrementer interrupts in LPCR.
46124be85a2SGautham R. Shenoy 	 *
46224be85a2SGautham R. Shenoy 	 * Further, we want stop states to be woken up by decrementer
46324be85a2SGautham R. Shenoy 	 * for non-hotplug cases. So program the LPCR via stop api as
46424be85a2SGautham R. Shenoy 	 * well.
46524be85a2SGautham R. Shenoy 	 */
46624be85a2SGautham R. Shenoy 	lpcr_val = mfspr(SPRN_LPCR) | (u64)LPCR_PECE1;
46724be85a2SGautham R. Shenoy 	pnv_program_cpu_hotplug_lpcr(cpu, lpcr_val);
46824be85a2SGautham R. Shenoy 
469a7cd88daSGautham R. Shenoy 	return srr1;
470a7cd88daSGautham R. Shenoy }
47167d20418SNicholas Piggin #endif
472a7cd88daSGautham R. Shenoy 
473a7cd88daSGautham R. Shenoy /*
474bcef83a0SShreyas B. Prabhu  * Power ISA 3.0 idle initialization.
475bcef83a0SShreyas B. Prabhu  *
476bcef83a0SShreyas B. Prabhu  * POWER ISA 3.0 defines a new SPR Processor stop Status and Control
477bcef83a0SShreyas B. Prabhu  * Register (PSSCR) to control idle behavior.
478bcef83a0SShreyas B. Prabhu  *
479bcef83a0SShreyas B. Prabhu  * PSSCR layout:
480bcef83a0SShreyas B. Prabhu  * ----------------------------------------------------------
481bcef83a0SShreyas B. Prabhu  * | PLS | /// | SD | ESL | EC | PSLL | /// | TR | MTL | RL |
482bcef83a0SShreyas B. Prabhu  * ----------------------------------------------------------
483bcef83a0SShreyas B. Prabhu  * 0      4     41   42    43   44     48    54   56    60
484bcef83a0SShreyas B. Prabhu  *
485bcef83a0SShreyas B. Prabhu  * PSSCR key fields:
486bcef83a0SShreyas B. Prabhu  *	Bits 0:3  - Power-Saving Level Status (PLS). This field indicates the
487bcef83a0SShreyas B. Prabhu  *	lowest power-saving state the thread entered since stop instruction was
488bcef83a0SShreyas B. Prabhu  *	last executed.
489bcef83a0SShreyas B. Prabhu  *
490bcef83a0SShreyas B. Prabhu  *	Bit 41 - Status Disable(SD)
491bcef83a0SShreyas B. Prabhu  *	0 - Shows PLS entries
492bcef83a0SShreyas B. Prabhu  *	1 - PLS entries are all 0
493bcef83a0SShreyas B. Prabhu  *
494bcef83a0SShreyas B. Prabhu  *	Bit 42 - Enable State Loss
495bcef83a0SShreyas B. Prabhu  *	0 - No state is lost irrespective of other fields
496bcef83a0SShreyas B. Prabhu  *	1 - Allows state loss
497bcef83a0SShreyas B. Prabhu  *
498bcef83a0SShreyas B. Prabhu  *	Bit 43 - Exit Criterion
499bcef83a0SShreyas B. Prabhu  *	0 - Exit from power-save mode on any interrupt
500bcef83a0SShreyas B. Prabhu  *	1 - Exit from power-save mode controlled by LPCR's PECE bits
501bcef83a0SShreyas B. Prabhu  *
502bcef83a0SShreyas B. Prabhu  *	Bits 44:47 - Power-Saving Level Limit
503bcef83a0SShreyas B. Prabhu  *	This limits the power-saving level that can be entered into.
504bcef83a0SShreyas B. Prabhu  *
505bcef83a0SShreyas B. Prabhu  *	Bits 60:63 - Requested Level
506bcef83a0SShreyas B. Prabhu  *	Used to specify which power-saving level must be entered on executing
507bcef83a0SShreyas B. Prabhu  *	stop instruction
50809206b60SGautham R. Shenoy  */
50909206b60SGautham R. Shenoy 
51009206b60SGautham R. Shenoy int validate_psscr_val_mask(u64 *psscr_val, u64 *psscr_mask, u32 flags)
51109206b60SGautham R. Shenoy {
51209206b60SGautham R. Shenoy 	int err = 0;
51309206b60SGautham R. Shenoy 
51409206b60SGautham R. Shenoy 	/*
51509206b60SGautham R. Shenoy 	 * psscr_mask == 0xf indicates an older firmware.
51609206b60SGautham R. Shenoy 	 * Set remaining fields of psscr to the default values.
51709206b60SGautham R. Shenoy 	 * See NOTE above definition of PSSCR_HV_DEFAULT_VAL
51809206b60SGautham R. Shenoy 	 */
51909206b60SGautham R. Shenoy 	if (*psscr_mask == 0xf) {
52009206b60SGautham R. Shenoy 		*psscr_val = *psscr_val | PSSCR_HV_DEFAULT_VAL;
52109206b60SGautham R. Shenoy 		*psscr_mask = PSSCR_HV_DEFAULT_MASK;
52209206b60SGautham R. Shenoy 		return err;
52309206b60SGautham R. Shenoy 	}
52409206b60SGautham R. Shenoy 
52509206b60SGautham R. Shenoy 	/*
52609206b60SGautham R. Shenoy 	 * New firmware is expected to set the psscr_val bits correctly.
52709206b60SGautham R. Shenoy 	 * Validate that the following invariants are correctly maintained by
52809206b60SGautham R. Shenoy 	 * the new firmware.
52909206b60SGautham R. Shenoy 	 * - ESL bit value matches the EC bit value.
53009206b60SGautham R. Shenoy 	 * - ESL bit is set for all the deep stop states.
53109206b60SGautham R. Shenoy 	 */
53209206b60SGautham R. Shenoy 	if (GET_PSSCR_ESL(*psscr_val) != GET_PSSCR_EC(*psscr_val)) {
53309206b60SGautham R. Shenoy 		err = ERR_EC_ESL_MISMATCH;
53409206b60SGautham R. Shenoy 	} else if ((flags & OPAL_PM_LOSE_FULL_CONTEXT) &&
53509206b60SGautham R. Shenoy 		GET_PSSCR_ESL(*psscr_val) == 0) {
53609206b60SGautham R. Shenoy 		err = ERR_DEEP_STATE_ESL_MISMATCH;
53709206b60SGautham R. Shenoy 	}
53809206b60SGautham R. Shenoy 
53909206b60SGautham R. Shenoy 	return err;
54009206b60SGautham R. Shenoy }
54109206b60SGautham R. Shenoy 
54209206b60SGautham R. Shenoy /*
54309206b60SGautham R. Shenoy  * pnv_arch300_idle_init: Initializes the default idle state, first
54409206b60SGautham R. Shenoy  *                        deep idle state and deepest idle state on
54509206b60SGautham R. Shenoy  *                        ISA 3.0 CPUs.
546bcef83a0SShreyas B. Prabhu  *
547bcef83a0SShreyas B. Prabhu  * @np: /ibm,opal/power-mgt device node
548bcef83a0SShreyas B. Prabhu  * @flags: cpu-idle-state-flags array
549bcef83a0SShreyas B. Prabhu  * @dt_idle_states: Number of idle state entries
550bcef83a0SShreyas B. Prabhu  * Returns 0 on success
551bcef83a0SShreyas B. Prabhu  */
552dd34c74cSGautham R. Shenoy static int __init pnv_power9_idle_init(struct device_node *np, u32 *flags,
553bcef83a0SShreyas B. Prabhu 					int dt_idle_states)
554bcef83a0SShreyas B. Prabhu {
555bcef83a0SShreyas B. Prabhu 	u64 *psscr_val = NULL;
55609206b60SGautham R. Shenoy 	u64 *psscr_mask = NULL;
55709206b60SGautham R. Shenoy 	u32 *residency_ns = NULL;
55809206b60SGautham R. Shenoy 	u64 max_residency_ns = 0;
559bcef83a0SShreyas B. Prabhu 	int rc = 0, i;
560bcef83a0SShreyas B. Prabhu 
56109206b60SGautham R. Shenoy 	psscr_val = kcalloc(dt_idle_states, sizeof(*psscr_val), GFP_KERNEL);
56209206b60SGautham R. Shenoy 	psscr_mask = kcalloc(dt_idle_states, sizeof(*psscr_mask), GFP_KERNEL);
56309206b60SGautham R. Shenoy 	residency_ns = kcalloc(dt_idle_states, sizeof(*residency_ns),
564bcef83a0SShreyas B. Prabhu 			       GFP_KERNEL);
56509206b60SGautham R. Shenoy 
56609206b60SGautham R. Shenoy 	if (!psscr_val || !psscr_mask || !residency_ns) {
567bcef83a0SShreyas B. Prabhu 		rc = -1;
568bcef83a0SShreyas B. Prabhu 		goto out;
569bcef83a0SShreyas B. Prabhu 	}
57009206b60SGautham R. Shenoy 
571bcef83a0SShreyas B. Prabhu 	if (of_property_read_u64_array(np,
572bcef83a0SShreyas B. Prabhu 		"ibm,cpu-idle-state-psscr",
573bcef83a0SShreyas B. Prabhu 		psscr_val, dt_idle_states)) {
57409206b60SGautham R. Shenoy 		pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-psscr in DT\n");
57509206b60SGautham R. Shenoy 		rc = -1;
57609206b60SGautham R. Shenoy 		goto out;
57709206b60SGautham R. Shenoy 	}
57809206b60SGautham R. Shenoy 
57909206b60SGautham R. Shenoy 	if (of_property_read_u64_array(np,
58009206b60SGautham R. Shenoy 				       "ibm,cpu-idle-state-psscr-mask",
58109206b60SGautham R. Shenoy 				       psscr_mask, dt_idle_states)) {
58209206b60SGautham R. Shenoy 		pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-psscr-mask in DT\n");
58309206b60SGautham R. Shenoy 		rc = -1;
58409206b60SGautham R. Shenoy 		goto out;
58509206b60SGautham R. Shenoy 	}
58609206b60SGautham R. Shenoy 
58709206b60SGautham R. Shenoy 	if (of_property_read_u32_array(np,
58809206b60SGautham R. Shenoy 				       "ibm,cpu-idle-state-residency-ns",
58909206b60SGautham R. Shenoy 					residency_ns, dt_idle_states)) {
59009206b60SGautham R. Shenoy 		pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-residency-ns in DT\n");
591bcef83a0SShreyas B. Prabhu 		rc = -1;
592bcef83a0SShreyas B. Prabhu 		goto out;
593bcef83a0SShreyas B. Prabhu 	}
594bcef83a0SShreyas B. Prabhu 
595bcef83a0SShreyas B. Prabhu 	/*
59609206b60SGautham R. Shenoy 	 * Set pnv_first_deep_stop_state, pnv_deepest_stop_psscr_{val,mask},
59709206b60SGautham R. Shenoy 	 * and the pnv_default_stop_{val,mask}.
59809206b60SGautham R. Shenoy 	 *
599c0691f9dSShreyas B. Prabhu 	 * pnv_first_deep_stop_state should be set to the first stop
600c0691f9dSShreyas B. Prabhu 	 * level to cause hypervisor state loss.
60109206b60SGautham R. Shenoy 	 *
60209206b60SGautham R. Shenoy 	 * pnv_deepest_stop_{val,mask} should be set to values corresponding to
60309206b60SGautham R. Shenoy 	 * the deepest stop state.
60409206b60SGautham R. Shenoy 	 *
60509206b60SGautham R. Shenoy 	 * pnv_default_stop_{val,mask} should be set to values corresponding to
60609206b60SGautham R. Shenoy 	 * the shallowest (OPAL_PM_STOP_INST_FAST) loss-less stop state.
607bcef83a0SShreyas B. Prabhu 	 */
608bcef83a0SShreyas B. Prabhu 	pnv_first_deep_stop_state = MAX_STOP_STATE;
609bcef83a0SShreyas B. Prabhu 	for (i = 0; i < dt_idle_states; i++) {
61009206b60SGautham R. Shenoy 		int err;
611bcef83a0SShreyas B. Prabhu 		u64 psscr_rl = psscr_val[i] & PSSCR_RL_MASK;
612bcef83a0SShreyas B. Prabhu 
613bcef83a0SShreyas B. Prabhu 		if ((flags[i] & OPAL_PM_LOSE_FULL_CONTEXT) &&
614bcef83a0SShreyas B. Prabhu 		     (pnv_first_deep_stop_state > psscr_rl))
615bcef83a0SShreyas B. Prabhu 			pnv_first_deep_stop_state = psscr_rl;
616c0691f9dSShreyas B. Prabhu 
61709206b60SGautham R. Shenoy 		err = validate_psscr_val_mask(&psscr_val[i], &psscr_mask[i],
61809206b60SGautham R. Shenoy 					      flags[i]);
61909206b60SGautham R. Shenoy 		if (err) {
62009206b60SGautham R. Shenoy 			report_invalid_psscr_val(psscr_val[i], err);
62109206b60SGautham R. Shenoy 			continue;
62209206b60SGautham R. Shenoy 		}
62309206b60SGautham R. Shenoy 
62409206b60SGautham R. Shenoy 		if (max_residency_ns < residency_ns[i]) {
62509206b60SGautham R. Shenoy 			max_residency_ns = residency_ns[i];
62609206b60SGautham R. Shenoy 			pnv_deepest_stop_psscr_val = psscr_val[i];
62709206b60SGautham R. Shenoy 			pnv_deepest_stop_psscr_mask = psscr_mask[i];
628785a12afSGautham R. Shenoy 			pnv_deepest_stop_flag = flags[i];
62909206b60SGautham R. Shenoy 			deepest_stop_found = true;
63009206b60SGautham R. Shenoy 		}
63109206b60SGautham R. Shenoy 
63209206b60SGautham R. Shenoy 		if (!default_stop_found &&
63309206b60SGautham R. Shenoy 		    (flags[i] & OPAL_PM_STOP_INST_FAST)) {
63409206b60SGautham R. Shenoy 			pnv_default_stop_val = psscr_val[i];
63509206b60SGautham R. Shenoy 			pnv_default_stop_mask = psscr_mask[i];
63609206b60SGautham R. Shenoy 			default_stop_found = true;
63709206b60SGautham R. Shenoy 		}
63809206b60SGautham R. Shenoy 	}
63909206b60SGautham R. Shenoy 
640f3b3f284SGautham R. Shenoy 	if (unlikely(!default_stop_found)) {
641f3b3f284SGautham R. Shenoy 		pr_warn("cpuidle-powernv: No suitable default stop state found. Disabling platform idle.\n");
642f3b3f284SGautham R. Shenoy 	} else {
643f3b3f284SGautham R. Shenoy 		ppc_md.power_save = power9_idle;
644f3b3f284SGautham R. Shenoy 		pr_info("cpuidle-powernv: Default stop: psscr = 0x%016llx,mask=0x%016llx\n",
64509206b60SGautham R. Shenoy 			pnv_default_stop_val, pnv_default_stop_mask);
64609206b60SGautham R. Shenoy 	}
64709206b60SGautham R. Shenoy 
648f3b3f284SGautham R. Shenoy 	if (unlikely(!deepest_stop_found)) {
649f3b3f284SGautham R. Shenoy 		pr_warn("cpuidle-powernv: No suitable stop state for CPU-Hotplug. Offlined CPUs will busy wait");
650f3b3f284SGautham R. Shenoy 	} else {
651f3b3f284SGautham R. Shenoy 		pr_info("cpuidle-powernv: Deepest stop: psscr = 0x%016llx,mask=0x%016llx\n",
65209206b60SGautham R. Shenoy 			pnv_deepest_stop_psscr_val,
65309206b60SGautham R. Shenoy 			pnv_deepest_stop_psscr_mask);
654bcef83a0SShreyas B. Prabhu 	}
655bcef83a0SShreyas B. Prabhu 
656f3b3f284SGautham R. Shenoy 	pr_info("cpuidle-powernv: Requested Level (RL) value of first deep stop = 0x%llx\n",
657f3b3f284SGautham R. Shenoy 		pnv_first_deep_stop_state);
658bcef83a0SShreyas B. Prabhu out:
659bcef83a0SShreyas B. Prabhu 	kfree(psscr_val);
66009206b60SGautham R. Shenoy 	kfree(psscr_mask);
66109206b60SGautham R. Shenoy 	kfree(residency_ns);
662bcef83a0SShreyas B. Prabhu 	return rc;
663bcef83a0SShreyas B. Prabhu }
664bcef83a0SShreyas B. Prabhu 
665bcef83a0SShreyas B. Prabhu /*
666bcef83a0SShreyas B. Prabhu  * Probe device tree for supported idle states
667bcef83a0SShreyas B. Prabhu  */
668bcef83a0SShreyas B. Prabhu static void __init pnv_probe_idle_states(void)
669bcef83a0SShreyas B. Prabhu {
670bcef83a0SShreyas B. Prabhu 	struct device_node *np;
671d405a98cSShreyas B. Prabhu 	int dt_idle_states;
672bcef83a0SShreyas B. Prabhu 	u32 *flags = NULL;
673d405a98cSShreyas B. Prabhu 	int i;
674d405a98cSShreyas B. Prabhu 
675bcef83a0SShreyas B. Prabhu 	np = of_find_node_by_path("/ibm,opal/power-mgt");
676bcef83a0SShreyas B. Prabhu 	if (!np) {
677d405a98cSShreyas B. Prabhu 		pr_warn("opal: PowerMgmt Node not found\n");
678d405a98cSShreyas B. Prabhu 		goto out;
679d405a98cSShreyas B. Prabhu 	}
680bcef83a0SShreyas B. Prabhu 	dt_idle_states = of_property_count_u32_elems(np,
681d405a98cSShreyas B. Prabhu 			"ibm,cpu-idle-state-flags");
682d405a98cSShreyas B. Prabhu 	if (dt_idle_states < 0) {
683d405a98cSShreyas B. Prabhu 		pr_warn("cpuidle-powernv: no idle states found in the DT\n");
684d405a98cSShreyas B. Prabhu 		goto out;
685d405a98cSShreyas B. Prabhu 	}
686d405a98cSShreyas B. Prabhu 
687bcef83a0SShreyas B. Prabhu 	flags = kcalloc(dt_idle_states, sizeof(*flags),  GFP_KERNEL);
688bcef83a0SShreyas B. Prabhu 
689bcef83a0SShreyas B. Prabhu 	if (of_property_read_u32_array(np,
690d405a98cSShreyas B. Prabhu 			"ibm,cpu-idle-state-flags", flags, dt_idle_states)) {
691d405a98cSShreyas B. Prabhu 		pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-flags in DT\n");
692bcef83a0SShreyas B. Prabhu 		goto out;
693bcef83a0SShreyas B. Prabhu 	}
694bcef83a0SShreyas B. Prabhu 
695bcef83a0SShreyas B. Prabhu 	if (cpu_has_feature(CPU_FTR_ARCH_300)) {
696dd34c74cSGautham R. Shenoy 		if (pnv_power9_idle_init(np, flags, dt_idle_states))
697bcef83a0SShreyas B. Prabhu 			goto out;
698d405a98cSShreyas B. Prabhu 	}
699d405a98cSShreyas B. Prabhu 
700d405a98cSShreyas B. Prabhu 	for (i = 0; i < dt_idle_states; i++)
701d405a98cSShreyas B. Prabhu 		supported_cpuidle_states |= flags[i];
702d405a98cSShreyas B. Prabhu 
703bcef83a0SShreyas B. Prabhu out:
704bcef83a0SShreyas B. Prabhu 	kfree(flags);
705bcef83a0SShreyas B. Prabhu }
706bcef83a0SShreyas B. Prabhu static int __init pnv_init_idle_states(void)
707bcef83a0SShreyas B. Prabhu {
708bcef83a0SShreyas B. Prabhu 
709bcef83a0SShreyas B. Prabhu 	supported_cpuidle_states = 0;
710bcef83a0SShreyas B. Prabhu 
711bcef83a0SShreyas B. Prabhu 	if (cpuidle_disable != IDLE_NO_OVERRIDE)
712bcef83a0SShreyas B. Prabhu 		goto out;
713bcef83a0SShreyas B. Prabhu 
714bcef83a0SShreyas B. Prabhu 	pnv_probe_idle_states();
715bcef83a0SShreyas B. Prabhu 
716d405a98cSShreyas B. Prabhu 	if (!(supported_cpuidle_states & OPAL_PM_SLEEP_ENABLED_ER1)) {
717d405a98cSShreyas B. Prabhu 		patch_instruction(
718d405a98cSShreyas B. Prabhu 			(unsigned int *)pnv_fastsleep_workaround_at_entry,
719d405a98cSShreyas B. Prabhu 			PPC_INST_NOP);
720d405a98cSShreyas B. Prabhu 		patch_instruction(
721d405a98cSShreyas B. Prabhu 			(unsigned int *)pnv_fastsleep_workaround_at_exit,
722d405a98cSShreyas B. Prabhu 			PPC_INST_NOP);
7235703d2f4SShreyas B. Prabhu 	} else {
7245703d2f4SShreyas B. Prabhu 		/*
7255703d2f4SShreyas B. Prabhu 		 * OPAL_PM_SLEEP_ENABLED_ER1 is set. It indicates that
7265703d2f4SShreyas B. Prabhu 		 * workaround is needed to use fastsleep. Provide sysfs
7275703d2f4SShreyas B. Prabhu 		 * control to choose how this workaround has to be applied.
7285703d2f4SShreyas B. Prabhu 		 */
7295703d2f4SShreyas B. Prabhu 		device_create_file(cpu_subsys.dev_root,
7305703d2f4SShreyas B. Prabhu 				&dev_attr_fastsleep_workaround_applyonce);
731d405a98cSShreyas B. Prabhu 	}
7325703d2f4SShreyas B. Prabhu 
733d405a98cSShreyas B. Prabhu 	pnv_alloc_idle_core_states();
7345593e303SShreyas B. Prabhu 
73517ed4c8fSGautham R. Shenoy 	/*
73617ed4c8fSGautham R. Shenoy 	 * For each CPU, record its PACA address in each of it's
73717ed4c8fSGautham R. Shenoy 	 * sibling thread's PACA at the slot corresponding to this
73817ed4c8fSGautham R. Shenoy 	 * CPU's index in the core.
73917ed4c8fSGautham R. Shenoy 	 */
74017ed4c8fSGautham R. Shenoy 	if (cpu_has_feature(CPU_FTR_POWER9_DD1)) {
74117ed4c8fSGautham R. Shenoy 		int cpu;
74217ed4c8fSGautham R. Shenoy 
74317ed4c8fSGautham R. Shenoy 		pr_info("powernv: idle: Saving PACA pointers of all CPUs in their thread sibling PACA\n");
74417ed4c8fSGautham R. Shenoy 		for_each_possible_cpu(cpu) {
74517ed4c8fSGautham R. Shenoy 			int base_cpu = cpu_first_thread_sibling(cpu);
74617ed4c8fSGautham R. Shenoy 			int idx = cpu_thread_in_core(cpu);
74717ed4c8fSGautham R. Shenoy 			int i;
74817ed4c8fSGautham R. Shenoy 
74917ed4c8fSGautham R. Shenoy 			for (i = 0; i < threads_per_core; i++) {
75017ed4c8fSGautham R. Shenoy 				int j = base_cpu + i;
75117ed4c8fSGautham R. Shenoy 
752d2e60075SNicholas Piggin 				paca_ptrs[j]->thread_sibling_pacas[idx] =
753d2e60075SNicholas Piggin 					paca_ptrs[cpu];
75417ed4c8fSGautham R. Shenoy 			}
75517ed4c8fSGautham R. Shenoy 		}
75617ed4c8fSGautham R. Shenoy 	}
75717ed4c8fSGautham R. Shenoy 
7585593e303SShreyas B. Prabhu 	if (supported_cpuidle_states & OPAL_PM_NAP_ENABLED)
7595593e303SShreyas B. Prabhu 		ppc_md.power_save = power7_idle;
760bcef83a0SShreyas B. Prabhu 
761d405a98cSShreyas B. Prabhu out:
762d405a98cSShreyas B. Prabhu 	return 0;
763d405a98cSShreyas B. Prabhu }
7644bece972SMichael Ellerman machine_subsys_initcall(powernv, pnv_init_idle_states);
765