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 1910d91611SNicholas Piggin #include <asm/asm-prototypes.h> 20d405a98cSShreyas B. Prabhu #include <asm/firmware.h> 214bece972SMichael Ellerman #include <asm/machdep.h> 22d405a98cSShreyas B. Prabhu #include <asm/opal.h> 23d405a98cSShreyas B. Prabhu #include <asm/cputhreads.h> 24d405a98cSShreyas B. Prabhu #include <asm/cpuidle.h> 25d405a98cSShreyas B. Prabhu #include <asm/code-patching.h> 26d405a98cSShreyas B. Prabhu #include <asm/smp.h> 272201f994SNicholas Piggin #include <asm/runlatch.h> 287672691aSPaul Mackerras #include <asm/dbell.h> 29d405a98cSShreyas B. Prabhu 30d405a98cSShreyas B. Prabhu #include "powernv.h" 31d405a98cSShreyas B. Prabhu #include "subcore.h" 32d405a98cSShreyas B. Prabhu 33bcef83a0SShreyas B. Prabhu /* Power ISA 3.0 allows for stop states 0x0 - 0xF */ 34bcef83a0SShreyas B. Prabhu #define MAX_STOP_STATE 0xF 35bcef83a0SShreyas B. Prabhu 361e1601b3SAkshay Adiga #define P9_STOP_SPR_MSR 2000 371e1601b3SAkshay Adiga #define P9_STOP_SPR_PSSCR 855 381e1601b3SAkshay Adiga 39d405a98cSShreyas B. Prabhu static u32 supported_cpuidle_states; 409c7b185aSAkshay Adiga struct pnv_idle_states_t *pnv_idle_states; 419c7b185aSAkshay Adiga int nr_pnv_idle_states; 42d405a98cSShreyas B. Prabhu 431e1601b3SAkshay Adiga /* 441e1601b3SAkshay Adiga * The default stop state that will be used by ppc_md.power_save 451e1601b3SAkshay Adiga * function on platforms that support stop instruction. 461e1601b3SAkshay Adiga */ 471e1601b3SAkshay Adiga static u64 pnv_default_stop_val; 481e1601b3SAkshay Adiga static u64 pnv_default_stop_mask; 491e1601b3SAkshay Adiga static bool default_stop_found; 501e1601b3SAkshay Adiga 511e1601b3SAkshay Adiga /* 5210d91611SNicholas Piggin * First stop state levels when SPR and TB loss can occur. 531e1601b3SAkshay Adiga */ 5410d91611SNicholas Piggin static u64 pnv_first_tb_loss_level = MAX_STOP_STATE + 1; 5510d91611SNicholas Piggin static u64 pnv_first_spr_loss_level = MAX_STOP_STATE + 1; 561e1601b3SAkshay Adiga 571e1601b3SAkshay Adiga /* 581e1601b3SAkshay Adiga * psscr value and mask of the deepest stop idle state. 591e1601b3SAkshay Adiga * Used when a cpu is offlined. 601e1601b3SAkshay Adiga */ 611e1601b3SAkshay Adiga static u64 pnv_deepest_stop_psscr_val; 621e1601b3SAkshay Adiga static u64 pnv_deepest_stop_psscr_mask; 63785a12afSGautham R. Shenoy static u64 pnv_deepest_stop_flag; 641e1601b3SAkshay Adiga static bool deepest_stop_found; 651e1601b3SAkshay Adiga 6610d91611SNicholas Piggin static unsigned long power7_offline_type; 6710d91611SNicholas Piggin 68bcef83a0SShreyas B. Prabhu static int pnv_save_sprs_for_deep_states(void) 69d405a98cSShreyas B. Prabhu { 70d405a98cSShreyas B. Prabhu int cpu; 71d405a98cSShreyas B. Prabhu int rc; 72d405a98cSShreyas B. Prabhu 73d405a98cSShreyas B. Prabhu /* 74446957baSAdam Buchbinder * hid0, hid1, hid4, hid5, hmeer and lpcr values are symmetric across 75d405a98cSShreyas B. Prabhu * all cpus at boot. Get these reg values of current cpu and use the 76446957baSAdam Buchbinder * same across all cpus. 77d405a98cSShreyas B. Prabhu */ 7824be85a2SGautham R. Shenoy uint64_t lpcr_val = mfspr(SPRN_LPCR); 79d405a98cSShreyas B. Prabhu uint64_t hid0_val = mfspr(SPRN_HID0); 80d405a98cSShreyas B. Prabhu uint64_t hid1_val = mfspr(SPRN_HID1); 81d405a98cSShreyas B. Prabhu uint64_t hid4_val = mfspr(SPRN_HID4); 82d405a98cSShreyas B. Prabhu uint64_t hid5_val = mfspr(SPRN_HID5); 83d405a98cSShreyas B. Prabhu uint64_t hmeer_val = mfspr(SPRN_HMEER); 841e1601b3SAkshay Adiga uint64_t msr_val = MSR_IDLE; 851e1601b3SAkshay Adiga uint64_t psscr_val = pnv_deepest_stop_psscr_val; 86d405a98cSShreyas B. Prabhu 87ac9816dcSAkshay Adiga for_each_present_cpu(cpu) { 88d405a98cSShreyas B. Prabhu uint64_t pir = get_hard_smp_processor_id(cpu); 89d2e60075SNicholas Piggin uint64_t hsprg0_val = (uint64_t)paca_ptrs[cpu]; 90d405a98cSShreyas B. Prabhu 91d405a98cSShreyas B. Prabhu rc = opal_slw_set_reg(pir, SPRN_HSPRG0, hsprg0_val); 92d405a98cSShreyas B. Prabhu if (rc != 0) 93d405a98cSShreyas B. Prabhu return rc; 94d405a98cSShreyas B. Prabhu 95d405a98cSShreyas B. Prabhu rc = opal_slw_set_reg(pir, SPRN_LPCR, lpcr_val); 96d405a98cSShreyas B. Prabhu if (rc != 0) 97d405a98cSShreyas B. Prabhu return rc; 98d405a98cSShreyas B. Prabhu 991e1601b3SAkshay Adiga if (cpu_has_feature(CPU_FTR_ARCH_300)) { 1001e1601b3SAkshay Adiga rc = opal_slw_set_reg(pir, P9_STOP_SPR_MSR, msr_val); 1011e1601b3SAkshay Adiga if (rc) 1021e1601b3SAkshay Adiga return rc; 1031e1601b3SAkshay Adiga 1041e1601b3SAkshay Adiga rc = opal_slw_set_reg(pir, 1051e1601b3SAkshay Adiga P9_STOP_SPR_PSSCR, psscr_val); 1061e1601b3SAkshay Adiga 1071e1601b3SAkshay Adiga if (rc) 1081e1601b3SAkshay Adiga return rc; 1091e1601b3SAkshay Adiga } 1101e1601b3SAkshay Adiga 111d405a98cSShreyas B. Prabhu /* HIDs are per core registers */ 112d405a98cSShreyas B. Prabhu if (cpu_thread_in_core(cpu) == 0) { 113d405a98cSShreyas B. Prabhu 114d405a98cSShreyas B. Prabhu rc = opal_slw_set_reg(pir, SPRN_HMEER, hmeer_val); 115d405a98cSShreyas B. Prabhu if (rc != 0) 116d405a98cSShreyas B. Prabhu return rc; 117d405a98cSShreyas B. Prabhu 118d405a98cSShreyas B. Prabhu rc = opal_slw_set_reg(pir, SPRN_HID0, hid0_val); 119d405a98cSShreyas B. Prabhu if (rc != 0) 120d405a98cSShreyas B. Prabhu return rc; 121d405a98cSShreyas B. Prabhu 1221e1601b3SAkshay Adiga /* Only p8 needs to set extra HID regiters */ 1231e1601b3SAkshay Adiga if (!cpu_has_feature(CPU_FTR_ARCH_300)) { 1241e1601b3SAkshay Adiga 125d405a98cSShreyas B. Prabhu rc = opal_slw_set_reg(pir, SPRN_HID1, hid1_val); 126d405a98cSShreyas B. Prabhu if (rc != 0) 127d405a98cSShreyas B. Prabhu return rc; 128d405a98cSShreyas B. Prabhu 129d405a98cSShreyas B. Prabhu rc = opal_slw_set_reg(pir, SPRN_HID4, hid4_val); 130d405a98cSShreyas B. Prabhu if (rc != 0) 131d405a98cSShreyas B. Prabhu return rc; 132d405a98cSShreyas B. Prabhu 133d405a98cSShreyas B. Prabhu rc = opal_slw_set_reg(pir, SPRN_HID5, hid5_val); 134d405a98cSShreyas B. Prabhu if (rc != 0) 135d405a98cSShreyas B. Prabhu return rc; 136d405a98cSShreyas B. Prabhu } 137d405a98cSShreyas B. Prabhu } 1381e1601b3SAkshay Adiga } 139d405a98cSShreyas B. Prabhu 140d405a98cSShreyas B. Prabhu return 0; 141d405a98cSShreyas B. Prabhu } 142d405a98cSShreyas B. Prabhu 143d405a98cSShreyas B. Prabhu u32 pnv_get_supported_cpuidle_states(void) 144d405a98cSShreyas B. Prabhu { 145d405a98cSShreyas B. Prabhu return supported_cpuidle_states; 146d405a98cSShreyas B. Prabhu } 147d405a98cSShreyas B. Prabhu EXPORT_SYMBOL_GPL(pnv_get_supported_cpuidle_states); 148d405a98cSShreyas B. Prabhu 1495703d2f4SShreyas B. Prabhu static void pnv_fastsleep_workaround_apply(void *info) 1505703d2f4SShreyas B. Prabhu 1515703d2f4SShreyas B. Prabhu { 1525703d2f4SShreyas B. Prabhu int rc; 1535703d2f4SShreyas B. Prabhu int *err = info; 1545703d2f4SShreyas B. Prabhu 1555703d2f4SShreyas B. Prabhu rc = opal_config_cpu_idle_state(OPAL_CONFIG_IDLE_FASTSLEEP, 1565703d2f4SShreyas B. Prabhu OPAL_CONFIG_IDLE_APPLY); 1575703d2f4SShreyas B. Prabhu if (rc) 1585703d2f4SShreyas B. Prabhu *err = 1; 1595703d2f4SShreyas B. Prabhu } 1605703d2f4SShreyas B. Prabhu 16110d91611SNicholas Piggin static bool power7_fastsleep_workaround_entry = true; 16210d91611SNicholas Piggin static bool power7_fastsleep_workaround_exit = true; 16310d91611SNicholas Piggin 1645703d2f4SShreyas B. Prabhu /* 1655703d2f4SShreyas B. Prabhu * Used to store fastsleep workaround state 1665703d2f4SShreyas B. Prabhu * 0 - Workaround applied/undone at fastsleep entry/exit path (Default) 1675703d2f4SShreyas B. Prabhu * 1 - Workaround applied once, never undone. 1685703d2f4SShreyas B. Prabhu */ 1695703d2f4SShreyas B. Prabhu static u8 fastsleep_workaround_applyonce; 1705703d2f4SShreyas B. Prabhu 1715703d2f4SShreyas B. Prabhu static ssize_t show_fastsleep_workaround_applyonce(struct device *dev, 1725703d2f4SShreyas B. Prabhu struct device_attribute *attr, char *buf) 1735703d2f4SShreyas B. Prabhu { 1745703d2f4SShreyas B. Prabhu return sprintf(buf, "%u\n", fastsleep_workaround_applyonce); 1755703d2f4SShreyas B. Prabhu } 1765703d2f4SShreyas B. Prabhu 1775703d2f4SShreyas B. Prabhu static ssize_t store_fastsleep_workaround_applyonce(struct device *dev, 1785703d2f4SShreyas B. Prabhu struct device_attribute *attr, const char *buf, 1795703d2f4SShreyas B. Prabhu size_t count) 1805703d2f4SShreyas B. Prabhu { 1815703d2f4SShreyas B. Prabhu cpumask_t primary_thread_mask; 1825703d2f4SShreyas B. Prabhu int err; 1835703d2f4SShreyas B. Prabhu u8 val; 1845703d2f4SShreyas B. Prabhu 1855703d2f4SShreyas B. Prabhu if (kstrtou8(buf, 0, &val) || val != 1) 1865703d2f4SShreyas B. Prabhu return -EINVAL; 1875703d2f4SShreyas B. Prabhu 1885703d2f4SShreyas B. Prabhu if (fastsleep_workaround_applyonce == 1) 1895703d2f4SShreyas B. Prabhu return count; 1905703d2f4SShreyas B. Prabhu 1915703d2f4SShreyas B. Prabhu /* 1925703d2f4SShreyas B. Prabhu * fastsleep_workaround_applyonce = 1 implies 1935703d2f4SShreyas B. Prabhu * fastsleep workaround needs to be left in 'applied' state on all 1945703d2f4SShreyas B. Prabhu * the cores. Do this by- 19510d91611SNicholas Piggin * 1. Disable the 'undo' workaround in fastsleep exit path 19610d91611SNicholas Piggin * 2. Sendi IPIs to all the cores which have at least one online thread 19710d91611SNicholas Piggin * 3. Disable the 'apply' workaround in fastsleep entry path 19810d91611SNicholas Piggin * 1995703d2f4SShreyas B. Prabhu * There is no need to send ipi to cores which have all threads 2005703d2f4SShreyas B. Prabhu * offlined, as last thread of the core entering fastsleep or deeper 2015703d2f4SShreyas B. Prabhu * state would have applied workaround. 2025703d2f4SShreyas B. Prabhu */ 20310d91611SNicholas Piggin power7_fastsleep_workaround_exit = false; 2045703d2f4SShreyas B. Prabhu 2055703d2f4SShreyas B. Prabhu get_online_cpus(); 2065703d2f4SShreyas B. Prabhu primary_thread_mask = cpu_online_cores_map(); 2075703d2f4SShreyas B. Prabhu on_each_cpu_mask(&primary_thread_mask, 2085703d2f4SShreyas B. Prabhu pnv_fastsleep_workaround_apply, 2095703d2f4SShreyas B. Prabhu &err, 1); 2105703d2f4SShreyas B. Prabhu put_online_cpus(); 2115703d2f4SShreyas B. Prabhu if (err) { 2125703d2f4SShreyas B. Prabhu pr_err("fastsleep_workaround_applyonce change failed while running pnv_fastsleep_workaround_apply"); 2135703d2f4SShreyas B. Prabhu goto fail; 2145703d2f4SShreyas B. Prabhu } 2155703d2f4SShreyas B. Prabhu 21610d91611SNicholas Piggin power7_fastsleep_workaround_entry = false; 2175703d2f4SShreyas B. Prabhu 2185703d2f4SShreyas B. Prabhu fastsleep_workaround_applyonce = 1; 2195703d2f4SShreyas B. Prabhu 2205703d2f4SShreyas B. Prabhu return count; 2215703d2f4SShreyas B. Prabhu fail: 2225703d2f4SShreyas B. Prabhu return -EIO; 2235703d2f4SShreyas B. Prabhu } 2245703d2f4SShreyas B. Prabhu 2255703d2f4SShreyas B. Prabhu static DEVICE_ATTR(fastsleep_workaround_applyonce, 0600, 2265703d2f4SShreyas B. Prabhu show_fastsleep_workaround_applyonce, 2275703d2f4SShreyas B. Prabhu store_fastsleep_workaround_applyonce); 2285703d2f4SShreyas B. Prabhu 22910d91611SNicholas Piggin static inline void atomic_start_thread_idle(void) 2302201f994SNicholas Piggin { 23110d91611SNicholas Piggin int cpu = raw_smp_processor_id(); 23210d91611SNicholas Piggin int first = cpu_first_thread_sibling(cpu); 23310d91611SNicholas Piggin int thread_nr = cpu_thread_in_core(cpu); 23410d91611SNicholas Piggin unsigned long *state = &paca_ptrs[first]->idle_state; 23510d91611SNicholas Piggin 23610d91611SNicholas Piggin clear_bit(thread_nr, state); 23710d91611SNicholas Piggin } 23810d91611SNicholas Piggin 23910d91611SNicholas Piggin static inline void atomic_stop_thread_idle(void) 24010d91611SNicholas Piggin { 24110d91611SNicholas Piggin int cpu = raw_smp_processor_id(); 24210d91611SNicholas Piggin int first = cpu_first_thread_sibling(cpu); 24310d91611SNicholas Piggin int thread_nr = cpu_thread_in_core(cpu); 24410d91611SNicholas Piggin unsigned long *state = &paca_ptrs[first]->idle_state; 24510d91611SNicholas Piggin 24610d91611SNicholas Piggin set_bit(thread_nr, state); 24710d91611SNicholas Piggin } 24810d91611SNicholas Piggin 24910d91611SNicholas Piggin static inline void atomic_lock_thread_idle(void) 25010d91611SNicholas Piggin { 25110d91611SNicholas Piggin int cpu = raw_smp_processor_id(); 25210d91611SNicholas Piggin int first = cpu_first_thread_sibling(cpu); 25310d91611SNicholas Piggin unsigned long *state = &paca_ptrs[first]->idle_state; 25410d91611SNicholas Piggin 25510d91611SNicholas Piggin while (unlikely(test_and_set_bit_lock(NR_PNV_CORE_IDLE_LOCK_BIT, state))) 25610d91611SNicholas Piggin barrier(); 25710d91611SNicholas Piggin } 25810d91611SNicholas Piggin 25910d91611SNicholas Piggin static inline void atomic_unlock_and_stop_thread_idle(void) 26010d91611SNicholas Piggin { 26110d91611SNicholas Piggin int cpu = raw_smp_processor_id(); 26210d91611SNicholas Piggin int first = cpu_first_thread_sibling(cpu); 26310d91611SNicholas Piggin unsigned long thread = 1UL << cpu_thread_in_core(cpu); 26410d91611SNicholas Piggin unsigned long *state = &paca_ptrs[first]->idle_state; 26510d91611SNicholas Piggin u64 s = READ_ONCE(*state); 26610d91611SNicholas Piggin u64 new, tmp; 26710d91611SNicholas Piggin 26810d91611SNicholas Piggin BUG_ON(!(s & PNV_CORE_IDLE_LOCK_BIT)); 26910d91611SNicholas Piggin BUG_ON(s & thread); 27010d91611SNicholas Piggin 27110d91611SNicholas Piggin again: 27210d91611SNicholas Piggin new = (s | thread) & ~PNV_CORE_IDLE_LOCK_BIT; 27310d91611SNicholas Piggin tmp = cmpxchg(state, s, new); 27410d91611SNicholas Piggin if (unlikely(tmp != s)) { 27510d91611SNicholas Piggin s = tmp; 27610d91611SNicholas Piggin goto again; 27710d91611SNicholas Piggin } 27810d91611SNicholas Piggin } 27910d91611SNicholas Piggin 28010d91611SNicholas Piggin static inline void atomic_unlock_thread_idle(void) 28110d91611SNicholas Piggin { 28210d91611SNicholas Piggin int cpu = raw_smp_processor_id(); 28310d91611SNicholas Piggin int first = cpu_first_thread_sibling(cpu); 28410d91611SNicholas Piggin unsigned long *state = &paca_ptrs[first]->idle_state; 28510d91611SNicholas Piggin 28610d91611SNicholas Piggin BUG_ON(!test_bit(NR_PNV_CORE_IDLE_LOCK_BIT, state)); 28710d91611SNicholas Piggin clear_bit_unlock(NR_PNV_CORE_IDLE_LOCK_BIT, state); 28810d91611SNicholas Piggin } 28910d91611SNicholas Piggin 29010d91611SNicholas Piggin /* P7 and P8 */ 29110d91611SNicholas Piggin struct p7_sprs { 29210d91611SNicholas Piggin /* per core */ 29310d91611SNicholas Piggin u64 tscr; 29410d91611SNicholas Piggin u64 worc; 29510d91611SNicholas Piggin 29610d91611SNicholas Piggin /* per subcore */ 29710d91611SNicholas Piggin u64 sdr1; 29810d91611SNicholas Piggin u64 rpr; 29910d91611SNicholas Piggin u64 amor; 30010d91611SNicholas Piggin 30110d91611SNicholas Piggin /* per thread */ 30210d91611SNicholas Piggin u64 lpcr; 30310d91611SNicholas Piggin u64 hfscr; 30410d91611SNicholas Piggin u64 fscr; 30510d91611SNicholas Piggin u64 purr; 30610d91611SNicholas Piggin u64 spurr; 30710d91611SNicholas Piggin u64 dscr; 30810d91611SNicholas Piggin u64 wort; 30910d91611SNicholas Piggin }; 31010d91611SNicholas Piggin 31110d91611SNicholas Piggin static unsigned long power7_idle_insn(unsigned long type) 31210d91611SNicholas Piggin { 31310d91611SNicholas Piggin int cpu = raw_smp_processor_id(); 31410d91611SNicholas Piggin int first = cpu_first_thread_sibling(cpu); 31510d91611SNicholas Piggin unsigned long *state = &paca_ptrs[first]->idle_state; 31610d91611SNicholas Piggin unsigned long thread = 1UL << cpu_thread_in_core(cpu); 31710d91611SNicholas Piggin unsigned long core_thread_mask = (1UL << threads_per_core) - 1; 3182201f994SNicholas Piggin unsigned long srr1; 31910d91611SNicholas Piggin bool full_winkle; 32010d91611SNicholas Piggin struct p7_sprs sprs = {}; /* avoid false use-uninitialised */ 32110d91611SNicholas Piggin bool sprs_saved = false; 32210d91611SNicholas Piggin int rc; 3232201f994SNicholas Piggin 32410d91611SNicholas Piggin if (unlikely(type != PNV_THREAD_NAP)) { 32510d91611SNicholas Piggin atomic_lock_thread_idle(); 3262201f994SNicholas Piggin 32710d91611SNicholas Piggin BUG_ON(!(*state & thread)); 32810d91611SNicholas Piggin *state &= ~thread; 3292201f994SNicholas Piggin 33010d91611SNicholas Piggin if (power7_fastsleep_workaround_entry) { 33110d91611SNicholas Piggin if ((*state & core_thread_mask) == 0) { 33210d91611SNicholas Piggin rc = opal_config_cpu_idle_state( 33310d91611SNicholas Piggin OPAL_CONFIG_IDLE_FASTSLEEP, 33410d91611SNicholas Piggin OPAL_CONFIG_IDLE_APPLY); 33510d91611SNicholas Piggin BUG_ON(rc); 33610d91611SNicholas Piggin } 33710d91611SNicholas Piggin } 33810d91611SNicholas Piggin 33910d91611SNicholas Piggin if (type == PNV_THREAD_WINKLE) { 34010d91611SNicholas Piggin sprs.tscr = mfspr(SPRN_TSCR); 34110d91611SNicholas Piggin sprs.worc = mfspr(SPRN_WORC); 34210d91611SNicholas Piggin 34310d91611SNicholas Piggin sprs.sdr1 = mfspr(SPRN_SDR1); 34410d91611SNicholas Piggin sprs.rpr = mfspr(SPRN_RPR); 34510d91611SNicholas Piggin sprs.amor = mfspr(SPRN_AMOR); 34610d91611SNicholas Piggin 34710d91611SNicholas Piggin sprs.lpcr = mfspr(SPRN_LPCR); 34810d91611SNicholas Piggin if (cpu_has_feature(CPU_FTR_ARCH_207S)) { 34910d91611SNicholas Piggin sprs.hfscr = mfspr(SPRN_HFSCR); 35010d91611SNicholas Piggin sprs.fscr = mfspr(SPRN_FSCR); 35110d91611SNicholas Piggin } 35210d91611SNicholas Piggin sprs.purr = mfspr(SPRN_PURR); 35310d91611SNicholas Piggin sprs.spurr = mfspr(SPRN_SPURR); 35410d91611SNicholas Piggin sprs.dscr = mfspr(SPRN_DSCR); 35510d91611SNicholas Piggin sprs.wort = mfspr(SPRN_WORT); 35610d91611SNicholas Piggin 35710d91611SNicholas Piggin sprs_saved = true; 35810d91611SNicholas Piggin 35910d91611SNicholas Piggin /* 36010d91611SNicholas Piggin * Increment winkle counter and set all winkle bits if 36110d91611SNicholas Piggin * all threads are winkling. This allows wakeup side to 36210d91611SNicholas Piggin * distinguish between fast sleep and winkle state 36310d91611SNicholas Piggin * loss. Fast sleep still has to resync the timebase so 36410d91611SNicholas Piggin * this may not be a really big win. 36510d91611SNicholas Piggin */ 36610d91611SNicholas Piggin *state += 1 << PNV_CORE_IDLE_WINKLE_COUNT_SHIFT; 36710d91611SNicholas Piggin if ((*state & PNV_CORE_IDLE_WINKLE_COUNT_BITS) 36810d91611SNicholas Piggin >> PNV_CORE_IDLE_WINKLE_COUNT_SHIFT 36910d91611SNicholas Piggin == threads_per_core) 37010d91611SNicholas Piggin *state |= PNV_CORE_IDLE_THREAD_WINKLE_BITS; 37110d91611SNicholas Piggin WARN_ON((*state & PNV_CORE_IDLE_WINKLE_COUNT_BITS) == 0); 37210d91611SNicholas Piggin } 37310d91611SNicholas Piggin 37410d91611SNicholas Piggin atomic_unlock_thread_idle(); 37510d91611SNicholas Piggin } 37610d91611SNicholas Piggin 37710d91611SNicholas Piggin local_paca->thread_idle_state = type; 37810d91611SNicholas Piggin srr1 = isa206_idle_insn_mayloss(type); /* go idle */ 37910d91611SNicholas Piggin local_paca->thread_idle_state = PNV_THREAD_RUNNING; 38010d91611SNicholas Piggin 38110d91611SNicholas Piggin WARN_ON_ONCE(!srr1); 38210d91611SNicholas Piggin WARN_ON_ONCE(mfmsr() & (MSR_IR|MSR_DR)); 38310d91611SNicholas Piggin 38410d91611SNicholas Piggin if (unlikely((srr1 & SRR1_WAKEMASK_P8) == SRR1_WAKEHMI)) 38510d91611SNicholas Piggin hmi_exception_realmode(NULL); 38610d91611SNicholas Piggin 38710d91611SNicholas Piggin if (likely((srr1 & SRR1_WAKESTATE) != SRR1_WS_HVLOSS)) { 38810d91611SNicholas Piggin if (unlikely(type != PNV_THREAD_NAP)) { 38910d91611SNicholas Piggin atomic_lock_thread_idle(); 39010d91611SNicholas Piggin if (type == PNV_THREAD_WINKLE) { 39110d91611SNicholas Piggin WARN_ON((*state & PNV_CORE_IDLE_WINKLE_COUNT_BITS) == 0); 39210d91611SNicholas Piggin *state -= 1 << PNV_CORE_IDLE_WINKLE_COUNT_SHIFT; 39310d91611SNicholas Piggin *state &= ~(thread << PNV_CORE_IDLE_THREAD_WINKLE_BITS_SHIFT); 39410d91611SNicholas Piggin } 39510d91611SNicholas Piggin atomic_unlock_and_stop_thread_idle(); 39610d91611SNicholas Piggin } 39710d91611SNicholas Piggin return srr1; 39810d91611SNicholas Piggin } 39910d91611SNicholas Piggin 40010d91611SNicholas Piggin /* HV state loss */ 40110d91611SNicholas Piggin BUG_ON(type == PNV_THREAD_NAP); 40210d91611SNicholas Piggin 40310d91611SNicholas Piggin atomic_lock_thread_idle(); 40410d91611SNicholas Piggin 40510d91611SNicholas Piggin full_winkle = false; 40610d91611SNicholas Piggin if (type == PNV_THREAD_WINKLE) { 40710d91611SNicholas Piggin WARN_ON((*state & PNV_CORE_IDLE_WINKLE_COUNT_BITS) == 0); 40810d91611SNicholas Piggin *state -= 1 << PNV_CORE_IDLE_WINKLE_COUNT_SHIFT; 40910d91611SNicholas Piggin if (*state & (thread << PNV_CORE_IDLE_THREAD_WINKLE_BITS_SHIFT)) { 41010d91611SNicholas Piggin *state &= ~(thread << PNV_CORE_IDLE_THREAD_WINKLE_BITS_SHIFT); 41110d91611SNicholas Piggin full_winkle = true; 41210d91611SNicholas Piggin BUG_ON(!sprs_saved); 41310d91611SNicholas Piggin } 41410d91611SNicholas Piggin } 41510d91611SNicholas Piggin 41610d91611SNicholas Piggin WARN_ON(*state & thread); 41710d91611SNicholas Piggin 41810d91611SNicholas Piggin if ((*state & core_thread_mask) != 0) 41910d91611SNicholas Piggin goto core_woken; 42010d91611SNicholas Piggin 42110d91611SNicholas Piggin /* Per-core SPRs */ 42210d91611SNicholas Piggin if (full_winkle) { 42310d91611SNicholas Piggin mtspr(SPRN_TSCR, sprs.tscr); 42410d91611SNicholas Piggin mtspr(SPRN_WORC, sprs.worc); 42510d91611SNicholas Piggin } 42610d91611SNicholas Piggin 42710d91611SNicholas Piggin if (power7_fastsleep_workaround_exit) { 42810d91611SNicholas Piggin rc = opal_config_cpu_idle_state(OPAL_CONFIG_IDLE_FASTSLEEP, 42910d91611SNicholas Piggin OPAL_CONFIG_IDLE_UNDO); 43010d91611SNicholas Piggin BUG_ON(rc); 43110d91611SNicholas Piggin } 43210d91611SNicholas Piggin 43310d91611SNicholas Piggin /* TB */ 43410d91611SNicholas Piggin if (opal_resync_timebase() != OPAL_SUCCESS) 43510d91611SNicholas Piggin BUG(); 43610d91611SNicholas Piggin 43710d91611SNicholas Piggin core_woken: 43810d91611SNicholas Piggin if (!full_winkle) 43910d91611SNicholas Piggin goto subcore_woken; 44010d91611SNicholas Piggin 44110d91611SNicholas Piggin if ((*state & local_paca->subcore_sibling_mask) != 0) 44210d91611SNicholas Piggin goto subcore_woken; 44310d91611SNicholas Piggin 44410d91611SNicholas Piggin /* Per-subcore SPRs */ 44510d91611SNicholas Piggin mtspr(SPRN_SDR1, sprs.sdr1); 44610d91611SNicholas Piggin mtspr(SPRN_RPR, sprs.rpr); 44710d91611SNicholas Piggin mtspr(SPRN_AMOR, sprs.amor); 44810d91611SNicholas Piggin 44910d91611SNicholas Piggin subcore_woken: 45010d91611SNicholas Piggin /* 45110d91611SNicholas Piggin * isync after restoring shared SPRs and before unlocking. Unlock 45210d91611SNicholas Piggin * only contains hwsync which does not necessarily do the right 45310d91611SNicholas Piggin * thing for SPRs. 45410d91611SNicholas Piggin */ 45510d91611SNicholas Piggin isync(); 45610d91611SNicholas Piggin atomic_unlock_and_stop_thread_idle(); 45710d91611SNicholas Piggin 45810d91611SNicholas Piggin /* Fast sleep does not lose SPRs */ 45910d91611SNicholas Piggin if (!full_winkle) 46010d91611SNicholas Piggin return srr1; 46110d91611SNicholas Piggin 46210d91611SNicholas Piggin /* Per-thread SPRs */ 46310d91611SNicholas Piggin mtspr(SPRN_LPCR, sprs.lpcr); 46410d91611SNicholas Piggin if (cpu_has_feature(CPU_FTR_ARCH_207S)) { 46510d91611SNicholas Piggin mtspr(SPRN_HFSCR, sprs.hfscr); 46610d91611SNicholas Piggin mtspr(SPRN_FSCR, sprs.fscr); 46710d91611SNicholas Piggin } 46810d91611SNicholas Piggin mtspr(SPRN_PURR, sprs.purr); 46910d91611SNicholas Piggin mtspr(SPRN_SPURR, sprs.spurr); 47010d91611SNicholas Piggin mtspr(SPRN_DSCR, sprs.dscr); 47110d91611SNicholas Piggin mtspr(SPRN_WORT, sprs.wort); 47210d91611SNicholas Piggin 47310d91611SNicholas Piggin mtspr(SPRN_SPRG3, local_paca->sprg_vdso); 47410d91611SNicholas Piggin 47510d91611SNicholas Piggin /* 47610d91611SNicholas Piggin * The SLB has to be restored here, but it sometimes still 47710d91611SNicholas Piggin * contains entries, so the __ variant must be used to prevent 47810d91611SNicholas Piggin * multi hits. 47910d91611SNicholas Piggin */ 48010d91611SNicholas Piggin __slb_restore_bolted_realmode(); 4812201f994SNicholas Piggin 4822201f994SNicholas Piggin return srr1; 4832201f994SNicholas Piggin } 4842201f994SNicholas Piggin 48510d91611SNicholas Piggin extern unsigned long idle_kvm_start_guest(unsigned long srr1); 48610d91611SNicholas Piggin 48710d91611SNicholas Piggin #ifdef CONFIG_HOTPLUG_CPU 48810d91611SNicholas Piggin static unsigned long power7_offline(void) 48910d91611SNicholas Piggin { 49010d91611SNicholas Piggin unsigned long srr1; 49110d91611SNicholas Piggin 49210d91611SNicholas Piggin mtmsr(MSR_IDLE); 49310d91611SNicholas Piggin 49410d91611SNicholas Piggin #ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE 49510d91611SNicholas Piggin /* Tell KVM we're entering idle. */ 49610d91611SNicholas Piggin /******************************************************/ 49710d91611SNicholas Piggin /* N O T E W E L L ! ! ! N O T E W E L L */ 49810d91611SNicholas Piggin /* The following store to HSTATE_HWTHREAD_STATE(r13) */ 49910d91611SNicholas Piggin /* MUST occur in real mode, i.e. with the MMU off, */ 50010d91611SNicholas Piggin /* and the MMU must stay off until we clear this flag */ 50110d91611SNicholas Piggin /* and test HSTATE_HWTHREAD_REQ(r13) in */ 50210d91611SNicholas Piggin /* pnv_powersave_wakeup in this file. */ 50310d91611SNicholas Piggin /* The reason is that another thread can switch the */ 50410d91611SNicholas Piggin /* MMU to a guest context whenever this flag is set */ 50510d91611SNicholas Piggin /* to KVM_HWTHREAD_IN_IDLE, and if the MMU was on, */ 50610d91611SNicholas Piggin /* that would potentially cause this thread to start */ 50710d91611SNicholas Piggin /* executing instructions from guest memory in */ 50810d91611SNicholas Piggin /* hypervisor mode, leading to a host crash or data */ 50910d91611SNicholas Piggin /* corruption, or worse. */ 51010d91611SNicholas Piggin /******************************************************/ 51110d91611SNicholas Piggin local_paca->kvm_hstate.hwthread_state = KVM_HWTHREAD_IN_IDLE; 51210d91611SNicholas Piggin #endif 51310d91611SNicholas Piggin 51410d91611SNicholas Piggin __ppc64_runlatch_off(); 51510d91611SNicholas Piggin srr1 = power7_idle_insn(power7_offline_type); 51610d91611SNicholas Piggin __ppc64_runlatch_on(); 51710d91611SNicholas Piggin 51810d91611SNicholas Piggin #ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE 51910d91611SNicholas Piggin local_paca->kvm_hstate.hwthread_state = KVM_HWTHREAD_IN_KERNEL; 52010d91611SNicholas Piggin /* Order setting hwthread_state vs. testing hwthread_req */ 52110d91611SNicholas Piggin smp_mb(); 52210d91611SNicholas Piggin if (local_paca->kvm_hstate.hwthread_req) 52310d91611SNicholas Piggin srr1 = idle_kvm_start_guest(srr1); 52410d91611SNicholas Piggin #endif 52510d91611SNicholas Piggin 52610d91611SNicholas Piggin mtmsr(MSR_KERNEL); 52710d91611SNicholas Piggin 52810d91611SNicholas Piggin return srr1; 52910d91611SNicholas Piggin } 53010d91611SNicholas Piggin #endif 53110d91611SNicholas Piggin 5322201f994SNicholas Piggin void power7_idle_type(unsigned long type) 5332201f994SNicholas Piggin { 534771d4304SNicholas Piggin unsigned long srr1; 535771d4304SNicholas Piggin 53610d91611SNicholas Piggin if (!prep_irq_for_idle_irqsoff()) 53710d91611SNicholas Piggin return; 53810d91611SNicholas Piggin 53910d91611SNicholas Piggin mtmsr(MSR_IDLE); 54010d91611SNicholas Piggin __ppc64_runlatch_off(); 54110d91611SNicholas Piggin srr1 = power7_idle_insn(type); 54210d91611SNicholas Piggin __ppc64_runlatch_on(); 54310d91611SNicholas Piggin mtmsr(MSR_KERNEL); 54410d91611SNicholas Piggin 54510d91611SNicholas Piggin fini_irq_for_idle_irqsoff(); 546771d4304SNicholas Piggin irq_set_pending_from_srr1(srr1); 5472201f994SNicholas Piggin } 5482201f994SNicholas Piggin 5492201f994SNicholas Piggin void power7_idle(void) 5502201f994SNicholas Piggin { 5512201f994SNicholas Piggin if (!powersave_nap) 5522201f994SNicholas Piggin return; 5532201f994SNicholas Piggin 5542201f994SNicholas Piggin power7_idle_type(PNV_THREAD_NAP); 5552201f994SNicholas Piggin } 5562201f994SNicholas Piggin 55710d91611SNicholas Piggin struct p9_sprs { 55810d91611SNicholas Piggin /* per core */ 55910d91611SNicholas Piggin u64 ptcr; 56010d91611SNicholas Piggin u64 rpr; 56110d91611SNicholas Piggin u64 tscr; 56210d91611SNicholas Piggin u64 ldbar; 56310d91611SNicholas Piggin u64 amor; 56410d91611SNicholas Piggin 56510d91611SNicholas Piggin /* per thread */ 56610d91611SNicholas Piggin u64 lpcr; 56710d91611SNicholas Piggin u64 hfscr; 56810d91611SNicholas Piggin u64 fscr; 56910d91611SNicholas Piggin u64 pid; 57010d91611SNicholas Piggin u64 purr; 57110d91611SNicholas Piggin u64 spurr; 57210d91611SNicholas Piggin u64 dscr; 57310d91611SNicholas Piggin u64 wort; 57410d91611SNicholas Piggin 57510d91611SNicholas Piggin u64 mmcra; 57610d91611SNicholas Piggin u32 mmcr0; 57710d91611SNicholas Piggin u32 mmcr1; 57810d91611SNicholas Piggin u64 mmcr2; 57910d91611SNicholas Piggin }; 58010d91611SNicholas Piggin 58110d91611SNicholas Piggin static unsigned long power9_idle_stop(unsigned long psscr, bool mmu_on) 58210d91611SNicholas Piggin { 58310d91611SNicholas Piggin int cpu = raw_smp_processor_id(); 58410d91611SNicholas Piggin int first = cpu_first_thread_sibling(cpu); 58510d91611SNicholas Piggin unsigned long *state = &paca_ptrs[first]->idle_state; 58610d91611SNicholas Piggin unsigned long core_thread_mask = (1UL << threads_per_core) - 1; 58710d91611SNicholas Piggin unsigned long srr1; 58810d91611SNicholas Piggin unsigned long pls; 58910d91611SNicholas Piggin unsigned long mmcr0 = 0; 59010d91611SNicholas Piggin struct p9_sprs sprs = {}; /* avoid false used-uninitialised */ 59110d91611SNicholas Piggin bool sprs_saved = false; 59210d91611SNicholas Piggin 59310d91611SNicholas Piggin if (!(psscr & (PSSCR_EC|PSSCR_ESL))) { 59410d91611SNicholas Piggin /* EC=ESL=0 case */ 59510d91611SNicholas Piggin 59610d91611SNicholas Piggin BUG_ON(!mmu_on); 59710d91611SNicholas Piggin 59810d91611SNicholas Piggin /* 59910d91611SNicholas Piggin * Wake synchronously. SRESET via xscom may still cause 60010d91611SNicholas Piggin * a 0x100 powersave wakeup with SRR1 reason! 60110d91611SNicholas Piggin */ 60210d91611SNicholas Piggin srr1 = isa300_idle_stop_noloss(psscr); /* go idle */ 60310d91611SNicholas Piggin if (likely(!srr1)) 60410d91611SNicholas Piggin return 0; 60510d91611SNicholas Piggin 60610d91611SNicholas Piggin /* 60710d91611SNicholas Piggin * Registers not saved, can't recover! 60810d91611SNicholas Piggin * This would be a hardware bug 60910d91611SNicholas Piggin */ 61010d91611SNicholas Piggin BUG_ON((srr1 & SRR1_WAKESTATE) != SRR1_WS_NOLOSS); 61110d91611SNicholas Piggin 61210d91611SNicholas Piggin goto out; 61310d91611SNicholas Piggin } 61410d91611SNicholas Piggin 61510d91611SNicholas Piggin /* EC=ESL=1 case */ 61610d91611SNicholas Piggin #ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE 61710d91611SNicholas Piggin if (cpu_has_feature(CPU_FTR_P9_TM_XER_SO_BUG)) { 61810d91611SNicholas Piggin local_paca->requested_psscr = psscr; 61910d91611SNicholas Piggin /* order setting requested_psscr vs testing dont_stop */ 62010d91611SNicholas Piggin smp_mb(); 62110d91611SNicholas Piggin if (atomic_read(&local_paca->dont_stop)) { 62210d91611SNicholas Piggin local_paca->requested_psscr = 0; 62310d91611SNicholas Piggin return 0; 62410d91611SNicholas Piggin } 62510d91611SNicholas Piggin } 62610d91611SNicholas Piggin #endif 62710d91611SNicholas Piggin 62810d91611SNicholas Piggin if (!cpu_has_feature(CPU_FTR_POWER9_DD2_1)) { 62910d91611SNicholas Piggin /* 63010d91611SNicholas Piggin * POWER9 DD2 can incorrectly set PMAO when waking up 63110d91611SNicholas Piggin * after a state-loss idle. Saving and restoring MMCR0 63210d91611SNicholas Piggin * over idle is a workaround. 63310d91611SNicholas Piggin */ 63410d91611SNicholas Piggin mmcr0 = mfspr(SPRN_MMCR0); 63510d91611SNicholas Piggin } 63610d91611SNicholas Piggin if ((psscr & PSSCR_RL_MASK) >= pnv_first_spr_loss_level) { 63710d91611SNicholas Piggin sprs.lpcr = mfspr(SPRN_LPCR); 63810d91611SNicholas Piggin sprs.hfscr = mfspr(SPRN_HFSCR); 63910d91611SNicholas Piggin sprs.fscr = mfspr(SPRN_FSCR); 64010d91611SNicholas Piggin sprs.pid = mfspr(SPRN_PID); 64110d91611SNicholas Piggin sprs.purr = mfspr(SPRN_PURR); 64210d91611SNicholas Piggin sprs.spurr = mfspr(SPRN_SPURR); 64310d91611SNicholas Piggin sprs.dscr = mfspr(SPRN_DSCR); 64410d91611SNicholas Piggin sprs.wort = mfspr(SPRN_WORT); 64510d91611SNicholas Piggin 64610d91611SNicholas Piggin sprs.mmcra = mfspr(SPRN_MMCRA); 64710d91611SNicholas Piggin sprs.mmcr0 = mfspr(SPRN_MMCR0); 64810d91611SNicholas Piggin sprs.mmcr1 = mfspr(SPRN_MMCR1); 64910d91611SNicholas Piggin sprs.mmcr2 = mfspr(SPRN_MMCR2); 65010d91611SNicholas Piggin 65110d91611SNicholas Piggin sprs.ptcr = mfspr(SPRN_PTCR); 65210d91611SNicholas Piggin sprs.rpr = mfspr(SPRN_RPR); 65310d91611SNicholas Piggin sprs.tscr = mfspr(SPRN_TSCR); 65410d91611SNicholas Piggin sprs.ldbar = mfspr(SPRN_LDBAR); 65510d91611SNicholas Piggin sprs.amor = mfspr(SPRN_AMOR); 65610d91611SNicholas Piggin 65710d91611SNicholas Piggin sprs_saved = true; 65810d91611SNicholas Piggin 65910d91611SNicholas Piggin atomic_start_thread_idle(); 66010d91611SNicholas Piggin } 66110d91611SNicholas Piggin 66210d91611SNicholas Piggin srr1 = isa300_idle_stop_mayloss(psscr); /* go idle */ 66310d91611SNicholas Piggin 66410d91611SNicholas Piggin #ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE 66510d91611SNicholas Piggin local_paca->requested_psscr = 0; 66610d91611SNicholas Piggin #endif 66710d91611SNicholas Piggin 66810d91611SNicholas Piggin psscr = mfspr(SPRN_PSSCR); 66910d91611SNicholas Piggin 67010d91611SNicholas Piggin WARN_ON_ONCE(!srr1); 67110d91611SNicholas Piggin WARN_ON_ONCE(mfmsr() & (MSR_IR|MSR_DR)); 67210d91611SNicholas Piggin 67310d91611SNicholas Piggin if ((srr1 & SRR1_WAKESTATE) != SRR1_WS_NOLOSS) { 67410d91611SNicholas Piggin unsigned long mmcra; 67510d91611SNicholas Piggin 67610d91611SNicholas Piggin /* 67710d91611SNicholas Piggin * Workaround for POWER9 DD2.0, if we lost resources, the ERAT 67810d91611SNicholas Piggin * might have been corrupted and needs flushing. We also need 67910d91611SNicholas Piggin * to reload MMCR0 (see mmcr0 comment above). 68010d91611SNicholas Piggin */ 68110d91611SNicholas Piggin if (!cpu_has_feature(CPU_FTR_POWER9_DD2_1)) { 68210d91611SNicholas Piggin asm volatile(PPC_INVALIDATE_ERAT); 68310d91611SNicholas Piggin mtspr(SPRN_MMCR0, mmcr0); 68410d91611SNicholas Piggin } 68510d91611SNicholas Piggin 68610d91611SNicholas Piggin /* 68710d91611SNicholas Piggin * DD2.2 and earlier need to set then clear bit 60 in MMCRA 68810d91611SNicholas Piggin * to ensure the PMU starts running. 68910d91611SNicholas Piggin */ 69010d91611SNicholas Piggin mmcra = mfspr(SPRN_MMCRA); 69110d91611SNicholas Piggin mmcra |= PPC_BIT(60); 69210d91611SNicholas Piggin mtspr(SPRN_MMCRA, mmcra); 69310d91611SNicholas Piggin mmcra &= ~PPC_BIT(60); 69410d91611SNicholas Piggin mtspr(SPRN_MMCRA, mmcra); 69510d91611SNicholas Piggin } 69610d91611SNicholas Piggin 69710d91611SNicholas Piggin if (unlikely((srr1 & SRR1_WAKEMASK_P8) == SRR1_WAKEHMI)) 69810d91611SNicholas Piggin hmi_exception_realmode(NULL); 69910d91611SNicholas Piggin 70010d91611SNicholas Piggin /* 70110d91611SNicholas Piggin * On POWER9, SRR1 bits do not match exactly as expected. 70210d91611SNicholas Piggin * SRR1_WS_GPRLOSS (10b) can also result in SPR loss, so 70310d91611SNicholas Piggin * just always test PSSCR for SPR/TB state loss. 70410d91611SNicholas Piggin */ 70510d91611SNicholas Piggin pls = (psscr & PSSCR_PLS) >> PSSCR_PLS_SHIFT; 70610d91611SNicholas Piggin if (likely(pls < pnv_first_spr_loss_level)) { 70710d91611SNicholas Piggin if (sprs_saved) 70810d91611SNicholas Piggin atomic_stop_thread_idle(); 70910d91611SNicholas Piggin goto out; 71010d91611SNicholas Piggin } 71110d91611SNicholas Piggin 71210d91611SNicholas Piggin /* HV state loss */ 71310d91611SNicholas Piggin BUG_ON(!sprs_saved); 71410d91611SNicholas Piggin 71510d91611SNicholas Piggin atomic_lock_thread_idle(); 71610d91611SNicholas Piggin 71710d91611SNicholas Piggin if ((*state & core_thread_mask) != 0) 71810d91611SNicholas Piggin goto core_woken; 71910d91611SNicholas Piggin 72010d91611SNicholas Piggin /* Per-core SPRs */ 72110d91611SNicholas Piggin mtspr(SPRN_PTCR, sprs.ptcr); 72210d91611SNicholas Piggin mtspr(SPRN_RPR, sprs.rpr); 72310d91611SNicholas Piggin mtspr(SPRN_TSCR, sprs.tscr); 72410d91611SNicholas Piggin mtspr(SPRN_LDBAR, sprs.ldbar); 72510d91611SNicholas Piggin mtspr(SPRN_AMOR, sprs.amor); 72610d91611SNicholas Piggin 72710d91611SNicholas Piggin if (pls >= pnv_first_tb_loss_level) { 72810d91611SNicholas Piggin /* TB loss */ 72910d91611SNicholas Piggin if (opal_resync_timebase() != OPAL_SUCCESS) 73010d91611SNicholas Piggin BUG(); 73110d91611SNicholas Piggin } 73210d91611SNicholas Piggin 73310d91611SNicholas Piggin /* 73410d91611SNicholas Piggin * isync after restoring shared SPRs and before unlocking. Unlock 73510d91611SNicholas Piggin * only contains hwsync which does not necessarily do the right 73610d91611SNicholas Piggin * thing for SPRs. 73710d91611SNicholas Piggin */ 73810d91611SNicholas Piggin isync(); 73910d91611SNicholas Piggin 74010d91611SNicholas Piggin core_woken: 74110d91611SNicholas Piggin atomic_unlock_and_stop_thread_idle(); 74210d91611SNicholas Piggin 74310d91611SNicholas Piggin /* Per-thread SPRs */ 74410d91611SNicholas Piggin mtspr(SPRN_LPCR, sprs.lpcr); 74510d91611SNicholas Piggin mtspr(SPRN_HFSCR, sprs.hfscr); 74610d91611SNicholas Piggin mtspr(SPRN_FSCR, sprs.fscr); 74710d91611SNicholas Piggin mtspr(SPRN_PID, sprs.pid); 74810d91611SNicholas Piggin mtspr(SPRN_PURR, sprs.purr); 74910d91611SNicholas Piggin mtspr(SPRN_SPURR, sprs.spurr); 75010d91611SNicholas Piggin mtspr(SPRN_DSCR, sprs.dscr); 75110d91611SNicholas Piggin mtspr(SPRN_WORT, sprs.wort); 75210d91611SNicholas Piggin 75310d91611SNicholas Piggin mtspr(SPRN_MMCRA, sprs.mmcra); 75410d91611SNicholas Piggin mtspr(SPRN_MMCR0, sprs.mmcr0); 75510d91611SNicholas Piggin mtspr(SPRN_MMCR1, sprs.mmcr1); 75610d91611SNicholas Piggin mtspr(SPRN_MMCR2, sprs.mmcr2); 75710d91611SNicholas Piggin 75810d91611SNicholas Piggin mtspr(SPRN_SPRG3, local_paca->sprg_vdso); 75910d91611SNicholas Piggin 76010d91611SNicholas Piggin if (!radix_enabled()) 76110d91611SNicholas Piggin __slb_restore_bolted_realmode(); 76210d91611SNicholas Piggin 76310d91611SNicholas Piggin out: 76410d91611SNicholas Piggin if (mmu_on) 76510d91611SNicholas Piggin mtmsr(MSR_KERNEL); 76610d91611SNicholas Piggin 76710d91611SNicholas Piggin return srr1; 76810d91611SNicholas Piggin } 76910d91611SNicholas Piggin 77010d91611SNicholas Piggin #ifdef CONFIG_HOTPLUG_CPU 77110d91611SNicholas Piggin static unsigned long power9_offline_stop(unsigned long psscr) 77210d91611SNicholas Piggin { 77310d91611SNicholas Piggin unsigned long srr1; 77410d91611SNicholas Piggin 77510d91611SNicholas Piggin #ifndef CONFIG_KVM_BOOK3S_HV_POSSIBLE 77610d91611SNicholas Piggin __ppc64_runlatch_off(); 77710d91611SNicholas Piggin srr1 = power9_idle_stop(psscr, true); 77810d91611SNicholas Piggin __ppc64_runlatch_on(); 77910d91611SNicholas Piggin #else 78010d91611SNicholas Piggin /* 78110d91611SNicholas Piggin * Tell KVM we're entering idle. 78210d91611SNicholas Piggin * This does not have to be done in real mode because the P9 MMU 78310d91611SNicholas Piggin * is independent per-thread. Some steppings share radix/hash mode 78410d91611SNicholas Piggin * between threads, but in that case KVM has a barrier sync in real 78510d91611SNicholas Piggin * mode before and after switching between radix and hash. 78610d91611SNicholas Piggin * 78710d91611SNicholas Piggin * kvm_start_guest must still be called in real mode though, hence 78810d91611SNicholas Piggin * the false argument. 78910d91611SNicholas Piggin */ 79010d91611SNicholas Piggin local_paca->kvm_hstate.hwthread_state = KVM_HWTHREAD_IN_IDLE; 79110d91611SNicholas Piggin 79210d91611SNicholas Piggin __ppc64_runlatch_off(); 79310d91611SNicholas Piggin srr1 = power9_idle_stop(psscr, false); 79410d91611SNicholas Piggin __ppc64_runlatch_on(); 79510d91611SNicholas Piggin 79610d91611SNicholas Piggin local_paca->kvm_hstate.hwthread_state = KVM_HWTHREAD_IN_KERNEL; 79710d91611SNicholas Piggin /* Order setting hwthread_state vs. testing hwthread_req */ 79810d91611SNicholas Piggin smp_mb(); 79910d91611SNicholas Piggin if (local_paca->kvm_hstate.hwthread_req) 80010d91611SNicholas Piggin srr1 = idle_kvm_start_guest(srr1); 80110d91611SNicholas Piggin mtmsr(MSR_KERNEL); 80210d91611SNicholas Piggin #endif 80310d91611SNicholas Piggin 80410d91611SNicholas Piggin return srr1; 80510d91611SNicholas Piggin } 80610d91611SNicholas Piggin #endif 80710d91611SNicholas Piggin 80810d91611SNicholas Piggin void power9_idle_type(unsigned long stop_psscr_val, 8092201f994SNicholas Piggin unsigned long stop_psscr_mask) 8102201f994SNicholas Piggin { 8112201f994SNicholas Piggin unsigned long psscr; 8122201f994SNicholas Piggin unsigned long srr1; 8132201f994SNicholas Piggin 8142201f994SNicholas Piggin if (!prep_irq_for_idle_irqsoff()) 81510d91611SNicholas Piggin return; 8162201f994SNicholas Piggin 8172201f994SNicholas Piggin psscr = mfspr(SPRN_PSSCR); 8182201f994SNicholas Piggin psscr = (psscr & ~stop_psscr_mask) | stop_psscr_val; 8192201f994SNicholas Piggin 82040d24343SNicholas Piggin __ppc64_runlatch_off(); 82110d91611SNicholas Piggin srr1 = power9_idle_stop(psscr, true); 82240d24343SNicholas Piggin __ppc64_runlatch_on(); 8232201f994SNicholas Piggin 8242201f994SNicholas Piggin fini_irq_for_idle_irqsoff(); 8252201f994SNicholas Piggin 826771d4304SNicholas Piggin irq_set_pending_from_srr1(srr1); 8272201f994SNicholas Piggin } 8282201f994SNicholas Piggin 82909206b60SGautham R. Shenoy /* 830bcef83a0SShreyas B. Prabhu * Used for ppc_md.power_save which needs a function with no parameters 831bcef83a0SShreyas B. Prabhu */ 8322201f994SNicholas Piggin void power9_idle(void) 833d405a98cSShreyas B. Prabhu { 8342201f994SNicholas Piggin power9_idle_type(pnv_default_stop_val, pnv_default_stop_mask); 835bcef83a0SShreyas B. Prabhu } 83609206b60SGautham R. Shenoy 8377672691aSPaul Mackerras #ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE 8387672691aSPaul Mackerras /* 8397672691aSPaul Mackerras * This is used in working around bugs in thread reconfiguration 8407672691aSPaul Mackerras * on POWER9 (at least up to Nimbus DD2.2) relating to transactional 8417672691aSPaul Mackerras * memory and the way that XER[SO] is checkpointed. 8427672691aSPaul Mackerras * This function forces the core into SMT4 in order by asking 8437672691aSPaul Mackerras * all other threads not to stop, and sending a message to any 8447672691aSPaul Mackerras * that are in a stop state. 8457672691aSPaul Mackerras * Must be called with preemption disabled. 8467672691aSPaul Mackerras */ 8477672691aSPaul Mackerras void pnv_power9_force_smt4_catch(void) 8487672691aSPaul Mackerras { 8497672691aSPaul Mackerras int cpu, cpu0, thr; 8507672691aSPaul Mackerras int awake_threads = 1; /* this thread is awake */ 8517672691aSPaul Mackerras int poke_threads = 0; 8527672691aSPaul Mackerras int need_awake = threads_per_core; 8537672691aSPaul Mackerras 8547672691aSPaul Mackerras cpu = smp_processor_id(); 8557672691aSPaul Mackerras cpu0 = cpu & ~(threads_per_core - 1); 8567672691aSPaul Mackerras for (thr = 0; thr < threads_per_core; ++thr) { 8577672691aSPaul Mackerras if (cpu != cpu0 + thr) 858f437c517SMichael Ellerman atomic_inc(&paca_ptrs[cpu0+thr]->dont_stop); 8597672691aSPaul Mackerras } 8607672691aSPaul Mackerras /* order setting dont_stop vs testing requested_psscr */ 86110d91611SNicholas Piggin smp_mb(); 8627672691aSPaul Mackerras for (thr = 0; thr < threads_per_core; ++thr) { 863f437c517SMichael Ellerman if (!paca_ptrs[cpu0+thr]->requested_psscr) 8647672691aSPaul Mackerras ++awake_threads; 8657672691aSPaul Mackerras else 8667672691aSPaul Mackerras poke_threads |= (1 << thr); 8677672691aSPaul Mackerras } 8687672691aSPaul Mackerras 8697672691aSPaul Mackerras /* If at least 3 threads are awake, the core is in SMT4 already */ 8707672691aSPaul Mackerras if (awake_threads < need_awake) { 8717672691aSPaul Mackerras /* We have to wake some threads; we'll use msgsnd */ 8727672691aSPaul Mackerras for (thr = 0; thr < threads_per_core; ++thr) { 8737672691aSPaul Mackerras if (poke_threads & (1 << thr)) { 8747672691aSPaul Mackerras ppc_msgsnd_sync(); 8757672691aSPaul Mackerras ppc_msgsnd(PPC_DBELL_MSGTYPE, 0, 876f437c517SMichael Ellerman paca_ptrs[cpu0+thr]->hw_cpu_id); 8777672691aSPaul Mackerras } 8787672691aSPaul Mackerras } 8797672691aSPaul Mackerras /* now spin until at least 3 threads are awake */ 8807672691aSPaul Mackerras do { 8817672691aSPaul Mackerras for (thr = 0; thr < threads_per_core; ++thr) { 8827672691aSPaul Mackerras if ((poke_threads & (1 << thr)) && 883f437c517SMichael Ellerman !paca_ptrs[cpu0+thr]->requested_psscr) { 8847672691aSPaul Mackerras ++awake_threads; 8857672691aSPaul Mackerras poke_threads &= ~(1 << thr); 8867672691aSPaul Mackerras } 8877672691aSPaul Mackerras } 8887672691aSPaul Mackerras } while (awake_threads < need_awake); 8897672691aSPaul Mackerras } 8907672691aSPaul Mackerras } 8917672691aSPaul Mackerras EXPORT_SYMBOL_GPL(pnv_power9_force_smt4_catch); 8927672691aSPaul Mackerras 8937672691aSPaul Mackerras void pnv_power9_force_smt4_release(void) 8947672691aSPaul Mackerras { 8957672691aSPaul Mackerras int cpu, cpu0, thr; 8967672691aSPaul Mackerras 8977672691aSPaul Mackerras cpu = smp_processor_id(); 8987672691aSPaul Mackerras cpu0 = cpu & ~(threads_per_core - 1); 8997672691aSPaul Mackerras 9007672691aSPaul Mackerras /* clear all the dont_stop flags */ 9017672691aSPaul Mackerras for (thr = 0; thr < threads_per_core; ++thr) { 9027672691aSPaul Mackerras if (cpu != cpu0 + thr) 903f437c517SMichael Ellerman atomic_dec(&paca_ptrs[cpu0+thr]->dont_stop); 9047672691aSPaul Mackerras } 9057672691aSPaul Mackerras } 9067672691aSPaul Mackerras EXPORT_SYMBOL_GPL(pnv_power9_force_smt4_release); 9077672691aSPaul Mackerras #endif /* CONFIG_KVM_BOOK3S_HV_POSSIBLE */ 9087672691aSPaul Mackerras 90967d20418SNicholas Piggin #ifdef CONFIG_HOTPLUG_CPU 91019f8a5b5SPaul Mackerras 91119f8a5b5SPaul Mackerras void pnv_program_cpu_hotplug_lpcr(unsigned int cpu, u64 lpcr_val) 91224be85a2SGautham R. Shenoy { 91324be85a2SGautham R. Shenoy u64 pir = get_hard_smp_processor_id(cpu); 91424be85a2SGautham R. Shenoy 91524be85a2SGautham R. Shenoy mtspr(SPRN_LPCR, lpcr_val); 9165d298baaSGautham R. Shenoy 9175d298baaSGautham R. Shenoy /* 9185d298baaSGautham R. Shenoy * Program the LPCR via stop-api only if the deepest stop state 9195d298baaSGautham R. Shenoy * can lose hypervisor context. 9205d298baaSGautham R. Shenoy */ 9215d298baaSGautham R. Shenoy if (supported_cpuidle_states & OPAL_PM_LOSE_FULL_CONTEXT) 92224be85a2SGautham R. Shenoy opal_slw_set_reg(pir, SPRN_LPCR, lpcr_val); 92324be85a2SGautham R. Shenoy } 92424be85a2SGautham R. Shenoy 925c0691f9dSShreyas B. Prabhu /* 926a7cd88daSGautham R. Shenoy * pnv_cpu_offline: A function that puts the CPU into the deepest 927a7cd88daSGautham R. Shenoy * available platform idle state on a CPU-Offline. 9282525db04SNicholas Piggin * interrupts hard disabled and no lazy irq pending. 929a7cd88daSGautham R. Shenoy */ 930a7cd88daSGautham R. Shenoy unsigned long pnv_cpu_offline(unsigned int cpu) 931a7cd88daSGautham R. Shenoy { 932a7cd88daSGautham R. Shenoy unsigned long srr1; 933a7cd88daSGautham R. Shenoy 93440d24343SNicholas Piggin __ppc64_runlatch_off(); 9352525db04SNicholas Piggin 936f3b3f284SGautham R. Shenoy if (cpu_has_feature(CPU_FTR_ARCH_300) && deepest_stop_found) { 9372525db04SNicholas Piggin unsigned long psscr; 9382525db04SNicholas Piggin 9392525db04SNicholas Piggin psscr = mfspr(SPRN_PSSCR); 9402525db04SNicholas Piggin psscr = (psscr & ~pnv_deepest_stop_psscr_mask) | 9412525db04SNicholas Piggin pnv_deepest_stop_psscr_val; 9423d4fbffdSNicholas Piggin srr1 = power9_offline_stop(psscr); 94310d91611SNicholas Piggin } else if (cpu_has_feature(CPU_FTR_ARCH_206) && power7_offline_type) { 94410d91611SNicholas Piggin srr1 = power7_offline(); 94590061231SGautham R. Shenoy } else { 94690061231SGautham R. Shenoy /* This is the fallback method. We emulate snooze */ 94790061231SGautham R. Shenoy while (!generic_check_cpu_restart(cpu)) { 94890061231SGautham R. Shenoy HMT_low(); 94990061231SGautham R. Shenoy HMT_very_low(); 95090061231SGautham R. Shenoy } 95190061231SGautham R. Shenoy srr1 = 0; 95290061231SGautham R. Shenoy HMT_medium(); 953a7cd88daSGautham R. Shenoy } 954a7cd88daSGautham R. Shenoy 95540d24343SNicholas Piggin __ppc64_runlatch_on(); 9562525db04SNicholas Piggin 957a7cd88daSGautham R. Shenoy return srr1; 958a7cd88daSGautham R. Shenoy } 95967d20418SNicholas Piggin #endif 960a7cd88daSGautham R. Shenoy 961a7cd88daSGautham R. Shenoy /* 962bcef83a0SShreyas B. Prabhu * Power ISA 3.0 idle initialization. 963bcef83a0SShreyas B. Prabhu * 964bcef83a0SShreyas B. Prabhu * POWER ISA 3.0 defines a new SPR Processor stop Status and Control 965bcef83a0SShreyas B. Prabhu * Register (PSSCR) to control idle behavior. 966bcef83a0SShreyas B. Prabhu * 967bcef83a0SShreyas B. Prabhu * PSSCR layout: 968bcef83a0SShreyas B. Prabhu * ---------------------------------------------------------- 969bcef83a0SShreyas B. Prabhu * | PLS | /// | SD | ESL | EC | PSLL | /// | TR | MTL | RL | 970bcef83a0SShreyas B. Prabhu * ---------------------------------------------------------- 971bcef83a0SShreyas B. Prabhu * 0 4 41 42 43 44 48 54 56 60 972bcef83a0SShreyas B. Prabhu * 973bcef83a0SShreyas B. Prabhu * PSSCR key fields: 974bcef83a0SShreyas B. Prabhu * Bits 0:3 - Power-Saving Level Status (PLS). This field indicates the 975bcef83a0SShreyas B. Prabhu * lowest power-saving state the thread entered since stop instruction was 976bcef83a0SShreyas B. Prabhu * last executed. 977bcef83a0SShreyas B. Prabhu * 978bcef83a0SShreyas B. Prabhu * Bit 41 - Status Disable(SD) 979bcef83a0SShreyas B. Prabhu * 0 - Shows PLS entries 980bcef83a0SShreyas B. Prabhu * 1 - PLS entries are all 0 981bcef83a0SShreyas B. Prabhu * 982bcef83a0SShreyas B. Prabhu * Bit 42 - Enable State Loss 983bcef83a0SShreyas B. Prabhu * 0 - No state is lost irrespective of other fields 984bcef83a0SShreyas B. Prabhu * 1 - Allows state loss 985bcef83a0SShreyas B. Prabhu * 986bcef83a0SShreyas B. Prabhu * Bit 43 - Exit Criterion 987bcef83a0SShreyas B. Prabhu * 0 - Exit from power-save mode on any interrupt 988bcef83a0SShreyas B. Prabhu * 1 - Exit from power-save mode controlled by LPCR's PECE bits 989bcef83a0SShreyas B. Prabhu * 990bcef83a0SShreyas B. Prabhu * Bits 44:47 - Power-Saving Level Limit 991bcef83a0SShreyas B. Prabhu * This limits the power-saving level that can be entered into. 992bcef83a0SShreyas B. Prabhu * 993bcef83a0SShreyas B. Prabhu * Bits 60:63 - Requested Level 994bcef83a0SShreyas B. Prabhu * Used to specify which power-saving level must be entered on executing 995bcef83a0SShreyas B. Prabhu * stop instruction 99609206b60SGautham R. Shenoy */ 99709206b60SGautham R. Shenoy 99809206b60SGautham R. Shenoy int validate_psscr_val_mask(u64 *psscr_val, u64 *psscr_mask, u32 flags) 99909206b60SGautham R. Shenoy { 100009206b60SGautham R. Shenoy int err = 0; 100109206b60SGautham R. Shenoy 100209206b60SGautham R. Shenoy /* 100309206b60SGautham R. Shenoy * psscr_mask == 0xf indicates an older firmware. 100409206b60SGautham R. Shenoy * Set remaining fields of psscr to the default values. 100509206b60SGautham R. Shenoy * See NOTE above definition of PSSCR_HV_DEFAULT_VAL 100609206b60SGautham R. Shenoy */ 100709206b60SGautham R. Shenoy if (*psscr_mask == 0xf) { 100809206b60SGautham R. Shenoy *psscr_val = *psscr_val | PSSCR_HV_DEFAULT_VAL; 100909206b60SGautham R. Shenoy *psscr_mask = PSSCR_HV_DEFAULT_MASK; 101009206b60SGautham R. Shenoy return err; 101109206b60SGautham R. Shenoy } 101209206b60SGautham R. Shenoy 101309206b60SGautham R. Shenoy /* 101409206b60SGautham R. Shenoy * New firmware is expected to set the psscr_val bits correctly. 101509206b60SGautham R. Shenoy * Validate that the following invariants are correctly maintained by 101609206b60SGautham R. Shenoy * the new firmware. 101709206b60SGautham R. Shenoy * - ESL bit value matches the EC bit value. 101809206b60SGautham R. Shenoy * - ESL bit is set for all the deep stop states. 101909206b60SGautham R. Shenoy */ 102009206b60SGautham R. Shenoy if (GET_PSSCR_ESL(*psscr_val) != GET_PSSCR_EC(*psscr_val)) { 102109206b60SGautham R. Shenoy err = ERR_EC_ESL_MISMATCH; 102209206b60SGautham R. Shenoy } else if ((flags & OPAL_PM_LOSE_FULL_CONTEXT) && 102309206b60SGautham R. Shenoy GET_PSSCR_ESL(*psscr_val) == 0) { 102409206b60SGautham R. Shenoy err = ERR_DEEP_STATE_ESL_MISMATCH; 102509206b60SGautham R. Shenoy } 102609206b60SGautham R. Shenoy 102709206b60SGautham R. Shenoy return err; 102809206b60SGautham R. Shenoy } 102909206b60SGautham R. Shenoy 103009206b60SGautham R. Shenoy /* 103109206b60SGautham R. Shenoy * pnv_arch300_idle_init: Initializes the default idle state, first 103209206b60SGautham R. Shenoy * deep idle state and deepest idle state on 103309206b60SGautham R. Shenoy * ISA 3.0 CPUs. 1034bcef83a0SShreyas B. Prabhu * 1035bcef83a0SShreyas B. Prabhu * @np: /ibm,opal/power-mgt device node 1036bcef83a0SShreyas B. Prabhu * @flags: cpu-idle-state-flags array 1037bcef83a0SShreyas B. Prabhu * @dt_idle_states: Number of idle state entries 1038bcef83a0SShreyas B. Prabhu * Returns 0 on success 1039bcef83a0SShreyas B. Prabhu */ 104010d91611SNicholas Piggin static void __init pnv_power9_idle_init(void) 1041bcef83a0SShreyas B. Prabhu { 104209206b60SGautham R. Shenoy u64 max_residency_ns = 0; 10439c7b185aSAkshay Adiga int i; 1044bcef83a0SShreyas B. Prabhu 1045bcef83a0SShreyas B. Prabhu /* 104609206b60SGautham R. Shenoy * pnv_deepest_stop_{val,mask} should be set to values corresponding to 104709206b60SGautham R. Shenoy * the deepest stop state. 104809206b60SGautham R. Shenoy * 104909206b60SGautham R. Shenoy * pnv_default_stop_{val,mask} should be set to values corresponding to 105010d91611SNicholas Piggin * the deepest loss-less (OPAL_PM_STOP_INST_FAST) stop state. 1051bcef83a0SShreyas B. Prabhu */ 105210d91611SNicholas Piggin pnv_first_tb_loss_level = MAX_STOP_STATE + 1; 105310d91611SNicholas Piggin pnv_first_spr_loss_level = MAX_STOP_STATE + 1; 10549c7b185aSAkshay Adiga for (i = 0; i < nr_pnv_idle_states; i++) { 105509206b60SGautham R. Shenoy int err; 10569c7b185aSAkshay Adiga struct pnv_idle_states_t *state = &pnv_idle_states[i]; 10579c7b185aSAkshay Adiga u64 psscr_rl = state->psscr_val & PSSCR_RL_MASK; 1058bcef83a0SShreyas B. Prabhu 105910d91611SNicholas Piggin if ((state->flags & OPAL_PM_TIMEBASE_STOP) && 106010d91611SNicholas Piggin (pnv_first_tb_loss_level > psscr_rl)) 106110d91611SNicholas Piggin pnv_first_tb_loss_level = psscr_rl; 106210d91611SNicholas Piggin 10639c7b185aSAkshay Adiga if ((state->flags & OPAL_PM_LOSE_FULL_CONTEXT) && 106410d91611SNicholas Piggin (pnv_first_spr_loss_level > psscr_rl)) 106510d91611SNicholas Piggin pnv_first_spr_loss_level = psscr_rl; 106610d91611SNicholas Piggin 106710d91611SNicholas Piggin /* 106810d91611SNicholas Piggin * The idle code does not deal with TB loss occurring 106910d91611SNicholas Piggin * in a shallower state than SPR loss, so force it to 107010d91611SNicholas Piggin * behave like SPRs are lost if TB is lost. POWER9 would 107110d91611SNicholas Piggin * never encouter this, but a POWER8 core would if it 107210d91611SNicholas Piggin * implemented the stop instruction. So this is for forward 107310d91611SNicholas Piggin * compatibility. 107410d91611SNicholas Piggin */ 107510d91611SNicholas Piggin if ((state->flags & OPAL_PM_TIMEBASE_STOP) && 107610d91611SNicholas Piggin (pnv_first_spr_loss_level > psscr_rl)) 107710d91611SNicholas Piggin pnv_first_spr_loss_level = psscr_rl; 1078c0691f9dSShreyas B. Prabhu 10799c7b185aSAkshay Adiga err = validate_psscr_val_mask(&state->psscr_val, 10809c7b185aSAkshay Adiga &state->psscr_mask, 10819c7b185aSAkshay Adiga state->flags); 108209206b60SGautham R. Shenoy if (err) { 10839c7b185aSAkshay Adiga report_invalid_psscr_val(state->psscr_val, err); 108409206b60SGautham R. Shenoy continue; 108509206b60SGautham R. Shenoy } 108609206b60SGautham R. Shenoy 10873127692dSNicholas Piggin state->valid = true; 10883127692dSNicholas Piggin 10899c7b185aSAkshay Adiga if (max_residency_ns < state->residency_ns) { 10909c7b185aSAkshay Adiga max_residency_ns = state->residency_ns; 10919c7b185aSAkshay Adiga pnv_deepest_stop_psscr_val = state->psscr_val; 10929c7b185aSAkshay Adiga pnv_deepest_stop_psscr_mask = state->psscr_mask; 10939c7b185aSAkshay Adiga pnv_deepest_stop_flag = state->flags; 109409206b60SGautham R. Shenoy deepest_stop_found = true; 109509206b60SGautham R. Shenoy } 109609206b60SGautham R. Shenoy 109709206b60SGautham R. Shenoy if (!default_stop_found && 10989c7b185aSAkshay Adiga (state->flags & OPAL_PM_STOP_INST_FAST)) { 10999c7b185aSAkshay Adiga pnv_default_stop_val = state->psscr_val; 11009c7b185aSAkshay Adiga pnv_default_stop_mask = state->psscr_mask; 110109206b60SGautham R. Shenoy default_stop_found = true; 110210d91611SNicholas Piggin WARN_ON(state->flags & OPAL_PM_LOSE_FULL_CONTEXT); 110309206b60SGautham R. Shenoy } 110409206b60SGautham R. Shenoy } 110509206b60SGautham R. Shenoy 1106f3b3f284SGautham R. Shenoy if (unlikely(!default_stop_found)) { 1107f3b3f284SGautham R. Shenoy pr_warn("cpuidle-powernv: No suitable default stop state found. Disabling platform idle.\n"); 1108f3b3f284SGautham R. Shenoy } else { 1109f3b3f284SGautham R. Shenoy ppc_md.power_save = power9_idle; 1110f3b3f284SGautham R. Shenoy pr_info("cpuidle-powernv: Default stop: psscr = 0x%016llx,mask=0x%016llx\n", 111109206b60SGautham R. Shenoy pnv_default_stop_val, pnv_default_stop_mask); 111209206b60SGautham R. Shenoy } 111309206b60SGautham R. Shenoy 1114f3b3f284SGautham R. Shenoy if (unlikely(!deepest_stop_found)) { 1115f3b3f284SGautham R. Shenoy pr_warn("cpuidle-powernv: No suitable stop state for CPU-Hotplug. Offlined CPUs will busy wait"); 1116f3b3f284SGautham R. Shenoy } else { 1117f3b3f284SGautham R. Shenoy pr_info("cpuidle-powernv: Deepest stop: psscr = 0x%016llx,mask=0x%016llx\n", 111809206b60SGautham R. Shenoy pnv_deepest_stop_psscr_val, 111909206b60SGautham R. Shenoy pnv_deepest_stop_psscr_mask); 1120bcef83a0SShreyas B. Prabhu } 1121bcef83a0SShreyas B. Prabhu 112210d91611SNicholas Piggin pr_info("cpuidle-powernv: First stop level that may lose SPRs = 0x%lld\n", 112310d91611SNicholas Piggin pnv_first_spr_loss_level); 11249c7b185aSAkshay Adiga 112510d91611SNicholas Piggin pr_info("cpuidle-powernv: First stop level that may lose timebase = 0x%lld\n", 112610d91611SNicholas Piggin pnv_first_tb_loss_level); 112710d91611SNicholas Piggin } 112810d91611SNicholas Piggin 112910d91611SNicholas Piggin static void __init pnv_disable_deep_states(void) 113010d91611SNicholas Piggin { 113110d91611SNicholas Piggin /* 113210d91611SNicholas Piggin * The stop-api is unable to restore hypervisor 113310d91611SNicholas Piggin * resources on wakeup from platform idle states which 113410d91611SNicholas Piggin * lose full context. So disable such states. 113510d91611SNicholas Piggin */ 113610d91611SNicholas Piggin supported_cpuidle_states &= ~OPAL_PM_LOSE_FULL_CONTEXT; 113710d91611SNicholas Piggin pr_warn("cpuidle-powernv: Disabling idle states that lose full context\n"); 113810d91611SNicholas Piggin pr_warn("cpuidle-powernv: Idle power-savings, CPU-Hotplug affected\n"); 113910d91611SNicholas Piggin 114010d91611SNicholas Piggin if (cpu_has_feature(CPU_FTR_ARCH_300) && 114110d91611SNicholas Piggin (pnv_deepest_stop_flag & OPAL_PM_LOSE_FULL_CONTEXT)) { 114210d91611SNicholas Piggin /* 114310d91611SNicholas Piggin * Use the default stop state for CPU-Hotplug 114410d91611SNicholas Piggin * if available. 114510d91611SNicholas Piggin */ 114610d91611SNicholas Piggin if (default_stop_found) { 114710d91611SNicholas Piggin pnv_deepest_stop_psscr_val = pnv_default_stop_val; 114810d91611SNicholas Piggin pnv_deepest_stop_psscr_mask = pnv_default_stop_mask; 114910d91611SNicholas Piggin pr_warn("cpuidle-powernv: Offlined CPUs will stop with psscr = 0x%016llx\n", 115010d91611SNicholas Piggin pnv_deepest_stop_psscr_val); 115110d91611SNicholas Piggin } else { /* Fallback to snooze loop for CPU-Hotplug */ 115210d91611SNicholas Piggin deepest_stop_found = false; 115310d91611SNicholas Piggin pr_warn("cpuidle-powernv: Offlined CPUs will busy wait\n"); 115410d91611SNicholas Piggin } 115510d91611SNicholas Piggin } 1156bcef83a0SShreyas B. Prabhu } 1157bcef83a0SShreyas B. Prabhu 1158bcef83a0SShreyas B. Prabhu /* 1159bcef83a0SShreyas B. Prabhu * Probe device tree for supported idle states 1160bcef83a0SShreyas B. Prabhu */ 1161bcef83a0SShreyas B. Prabhu static void __init pnv_probe_idle_states(void) 1162bcef83a0SShreyas B. Prabhu { 1163d405a98cSShreyas B. Prabhu int i; 1164d405a98cSShreyas B. Prabhu 11659c7b185aSAkshay Adiga if (nr_pnv_idle_states < 0) { 11669c7b185aSAkshay Adiga pr_warn("cpuidle-powernv: no idle states found in the DT\n"); 11679c7b185aSAkshay Adiga return; 11689c7b185aSAkshay Adiga } 11699c7b185aSAkshay Adiga 117010d91611SNicholas Piggin if (cpu_has_feature(CPU_FTR_ARCH_300)) 117110d91611SNicholas Piggin pnv_power9_idle_init(); 11729c7b185aSAkshay Adiga 11739c7b185aSAkshay Adiga for (i = 0; i < nr_pnv_idle_states; i++) 11749c7b185aSAkshay Adiga supported_cpuidle_states |= pnv_idle_states[i].flags; 11759c7b185aSAkshay Adiga } 11769c7b185aSAkshay Adiga 11779c7b185aSAkshay Adiga /* 11789c7b185aSAkshay Adiga * This function parses device-tree and populates all the information 11799c7b185aSAkshay Adiga * into pnv_idle_states structure. It also sets up nr_pnv_idle_states 11809c7b185aSAkshay Adiga * which is the number of cpuidle states discovered through device-tree. 11819c7b185aSAkshay Adiga */ 11829c7b185aSAkshay Adiga 11839c7b185aSAkshay Adiga static int pnv_parse_cpuidle_dt(void) 11849c7b185aSAkshay Adiga { 11859c7b185aSAkshay Adiga struct device_node *np; 11869c7b185aSAkshay Adiga int nr_idle_states, i; 11879c7b185aSAkshay Adiga int rc = 0; 11889c7b185aSAkshay Adiga u32 *temp_u32; 11899c7b185aSAkshay Adiga u64 *temp_u64; 11909c7b185aSAkshay Adiga const char **temp_string; 11919c7b185aSAkshay Adiga 1192bcef83a0SShreyas B. Prabhu np = of_find_node_by_path("/ibm,opal/power-mgt"); 1193bcef83a0SShreyas B. Prabhu if (!np) { 1194d405a98cSShreyas B. Prabhu pr_warn("opal: PowerMgmt Node not found\n"); 11959c7b185aSAkshay Adiga return -ENODEV; 1196d405a98cSShreyas B. Prabhu } 11979c7b185aSAkshay Adiga nr_idle_states = of_property_count_u32_elems(np, 1198d405a98cSShreyas B. Prabhu "ibm,cpu-idle-state-flags"); 11999c7b185aSAkshay Adiga 12009c7b185aSAkshay Adiga pnv_idle_states = kcalloc(nr_idle_states, sizeof(*pnv_idle_states), 12019c7b185aSAkshay Adiga GFP_KERNEL); 12029c7b185aSAkshay Adiga temp_u32 = kcalloc(nr_idle_states, sizeof(u32), GFP_KERNEL); 12039c7b185aSAkshay Adiga temp_u64 = kcalloc(nr_idle_states, sizeof(u64), GFP_KERNEL); 12049c7b185aSAkshay Adiga temp_string = kcalloc(nr_idle_states, sizeof(char *), GFP_KERNEL); 12059c7b185aSAkshay Adiga 12069c7b185aSAkshay Adiga if (!(pnv_idle_states && temp_u32 && temp_u64 && temp_string)) { 12079c7b185aSAkshay Adiga pr_err("Could not allocate memory for dt parsing\n"); 12089c7b185aSAkshay Adiga rc = -ENOMEM; 1209d405a98cSShreyas B. Prabhu goto out; 1210d405a98cSShreyas B. Prabhu } 1211d405a98cSShreyas B. Prabhu 12129c7b185aSAkshay Adiga /* Read flags */ 12139c7b185aSAkshay Adiga if (of_property_read_u32_array(np, "ibm,cpu-idle-state-flags", 12149c7b185aSAkshay Adiga temp_u32, nr_idle_states)) { 1215d405a98cSShreyas B. Prabhu pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-flags in DT\n"); 12169c7b185aSAkshay Adiga rc = -EINVAL; 1217bcef83a0SShreyas B. Prabhu goto out; 1218bcef83a0SShreyas B. Prabhu } 12199c7b185aSAkshay Adiga for (i = 0; i < nr_idle_states; i++) 12209c7b185aSAkshay Adiga pnv_idle_states[i].flags = temp_u32[i]; 1221bcef83a0SShreyas B. Prabhu 12229c7b185aSAkshay Adiga /* Read latencies */ 12239c7b185aSAkshay Adiga if (of_property_read_u32_array(np, "ibm,cpu-idle-state-latencies-ns", 12249c7b185aSAkshay Adiga temp_u32, nr_idle_states)) { 12259c7b185aSAkshay Adiga pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-latencies-ns in DT\n"); 12269c7b185aSAkshay Adiga rc = -EINVAL; 12279c7b185aSAkshay Adiga goto out; 12289c7b185aSAkshay Adiga } 12299c7b185aSAkshay Adiga for (i = 0; i < nr_idle_states; i++) 12309c7b185aSAkshay Adiga pnv_idle_states[i].latency_ns = temp_u32[i]; 12319c7b185aSAkshay Adiga 12329c7b185aSAkshay Adiga /* Read residencies */ 12339c7b185aSAkshay Adiga if (of_property_read_u32_array(np, "ibm,cpu-idle-state-residency-ns", 12349c7b185aSAkshay Adiga temp_u32, nr_idle_states)) { 12359c7b185aSAkshay Adiga pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-latencies-ns in DT\n"); 12369c7b185aSAkshay Adiga rc = -EINVAL; 12379c7b185aSAkshay Adiga goto out; 12389c7b185aSAkshay Adiga } 12399c7b185aSAkshay Adiga for (i = 0; i < nr_idle_states; i++) 12409c7b185aSAkshay Adiga pnv_idle_states[i].residency_ns = temp_u32[i]; 12419c7b185aSAkshay Adiga 12429c7b185aSAkshay Adiga /* For power9 */ 1243bcef83a0SShreyas B. Prabhu if (cpu_has_feature(CPU_FTR_ARCH_300)) { 12449c7b185aSAkshay Adiga /* Read pm_crtl_val */ 12459c7b185aSAkshay Adiga if (of_property_read_u64_array(np, "ibm,cpu-idle-state-psscr", 12469c7b185aSAkshay Adiga temp_u64, nr_idle_states)) { 12479c7b185aSAkshay Adiga pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-psscr in DT\n"); 12489c7b185aSAkshay Adiga rc = -EINVAL; 1249bcef83a0SShreyas B. Prabhu goto out; 1250d405a98cSShreyas B. Prabhu } 12519c7b185aSAkshay Adiga for (i = 0; i < nr_idle_states; i++) 12529c7b185aSAkshay Adiga pnv_idle_states[i].psscr_val = temp_u64[i]; 1253d405a98cSShreyas B. Prabhu 12549c7b185aSAkshay Adiga /* Read pm_crtl_mask */ 12559c7b185aSAkshay Adiga if (of_property_read_u64_array(np, "ibm,cpu-idle-state-psscr-mask", 12569c7b185aSAkshay Adiga temp_u64, nr_idle_states)) { 12579c7b185aSAkshay Adiga pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-psscr-mask in DT\n"); 12589c7b185aSAkshay Adiga rc = -EINVAL; 12599c7b185aSAkshay Adiga goto out; 1260bcef83a0SShreyas B. Prabhu } 12619c7b185aSAkshay Adiga for (i = 0; i < nr_idle_states; i++) 12629c7b185aSAkshay Adiga pnv_idle_states[i].psscr_mask = temp_u64[i]; 12639c7b185aSAkshay Adiga } 12649c7b185aSAkshay Adiga 12659c7b185aSAkshay Adiga /* 12669c7b185aSAkshay Adiga * power8 specific properties ibm,cpu-idle-state-pmicr-mask and 12679c7b185aSAkshay Adiga * ibm,cpu-idle-state-pmicr-val were never used and there is no 12689c7b185aSAkshay Adiga * plan to use it in near future. Hence, not parsing these properties 12699c7b185aSAkshay Adiga */ 12709c7b185aSAkshay Adiga 12719c7b185aSAkshay Adiga if (of_property_read_string_array(np, "ibm,cpu-idle-state-names", 12729c7b185aSAkshay Adiga temp_string, nr_idle_states) < 0) { 12739c7b185aSAkshay Adiga pr_warn("cpuidle-powernv: missing ibm,cpu-idle-state-names in DT\n"); 12749c7b185aSAkshay Adiga rc = -EINVAL; 12759c7b185aSAkshay Adiga goto out; 12769c7b185aSAkshay Adiga } 12779c7b185aSAkshay Adiga for (i = 0; i < nr_idle_states; i++) 1278ae24ce5eSAneesh Kumar K.V strlcpy(pnv_idle_states[i].name, temp_string[i], 12799c7b185aSAkshay Adiga PNV_IDLE_NAME_LEN); 12809c7b185aSAkshay Adiga nr_pnv_idle_states = nr_idle_states; 12819c7b185aSAkshay Adiga rc = 0; 12829c7b185aSAkshay Adiga out: 12839c7b185aSAkshay Adiga kfree(temp_u32); 12849c7b185aSAkshay Adiga kfree(temp_u64); 12859c7b185aSAkshay Adiga kfree(temp_string); 12869c7b185aSAkshay Adiga return rc; 12879c7b185aSAkshay Adiga } 12889c7b185aSAkshay Adiga 1289bcef83a0SShreyas B. Prabhu static int __init pnv_init_idle_states(void) 1290bcef83a0SShreyas B. Prabhu { 129110d91611SNicholas Piggin int cpu; 12929c7b185aSAkshay Adiga int rc = 0; 129310d91611SNicholas Piggin 129410d91611SNicholas Piggin /* Set up PACA fields */ 129510d91611SNicholas Piggin for_each_present_cpu(cpu) { 129610d91611SNicholas Piggin struct paca_struct *p = paca_ptrs[cpu]; 129710d91611SNicholas Piggin 129810d91611SNicholas Piggin p->idle_state = 0; 129910d91611SNicholas Piggin if (cpu == cpu_first_thread_sibling(cpu)) 130010d91611SNicholas Piggin p->idle_state = (1 << threads_per_core) - 1; 130110d91611SNicholas Piggin 130210d91611SNicholas Piggin if (!cpu_has_feature(CPU_FTR_ARCH_300)) { 130310d91611SNicholas Piggin /* P7/P8 nap */ 130410d91611SNicholas Piggin p->thread_idle_state = PNV_THREAD_RUNNING; 130510d91611SNicholas Piggin } else { 130610d91611SNicholas Piggin /* P9 stop */ 130710d91611SNicholas Piggin #ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE 130810d91611SNicholas Piggin p->requested_psscr = 0; 130910d91611SNicholas Piggin atomic_set(&p->dont_stop, 0); 131010d91611SNicholas Piggin #endif 131110d91611SNicholas Piggin } 131210d91611SNicholas Piggin } 1313bcef83a0SShreyas B. Prabhu 13149c7b185aSAkshay Adiga /* In case we error out nr_pnv_idle_states will be zero */ 13159c7b185aSAkshay Adiga nr_pnv_idle_states = 0; 131610d91611SNicholas Piggin supported_cpuidle_states = 0; 131710d91611SNicholas Piggin 1318bcef83a0SShreyas B. Prabhu if (cpuidle_disable != IDLE_NO_OVERRIDE) 1319bcef83a0SShreyas B. Prabhu goto out; 13209c7b185aSAkshay Adiga rc = pnv_parse_cpuidle_dt(); 13219c7b185aSAkshay Adiga if (rc) 13229c7b185aSAkshay Adiga return rc; 1323bcef83a0SShreyas B. Prabhu pnv_probe_idle_states(); 1324bcef83a0SShreyas B. Prabhu 132510d91611SNicholas Piggin if (!cpu_has_feature(CPU_FTR_ARCH_300)) { 1326d405a98cSShreyas B. Prabhu if (!(supported_cpuidle_states & OPAL_PM_SLEEP_ENABLED_ER1)) { 132710d91611SNicholas Piggin power7_fastsleep_workaround_entry = false; 132810d91611SNicholas Piggin power7_fastsleep_workaround_exit = false; 13295703d2f4SShreyas B. Prabhu } else { 13305703d2f4SShreyas B. Prabhu /* 13315703d2f4SShreyas B. Prabhu * OPAL_PM_SLEEP_ENABLED_ER1 is set. It indicates that 13325703d2f4SShreyas B. Prabhu * workaround is needed to use fastsleep. Provide sysfs 133310d91611SNicholas Piggin * control to choose how this workaround has to be 133410d91611SNicholas Piggin * applied. 13355703d2f4SShreyas B. Prabhu */ 13365703d2f4SShreyas B. Prabhu device_create_file(cpu_subsys.dev_root, 13375703d2f4SShreyas B. Prabhu &dev_attr_fastsleep_workaround_applyonce); 1338d405a98cSShreyas B. Prabhu } 13395703d2f4SShreyas B. Prabhu 134010d91611SNicholas Piggin update_subcore_sibling_mask(); 13415593e303SShreyas B. Prabhu 134210d91611SNicholas Piggin if (supported_cpuidle_states & OPAL_PM_NAP_ENABLED) { 13435593e303SShreyas B. Prabhu ppc_md.power_save = power7_idle; 134410d91611SNicholas Piggin power7_offline_type = PNV_THREAD_NAP; 134510d91611SNicholas Piggin } 134610d91611SNicholas Piggin 134710d91611SNicholas Piggin if ((supported_cpuidle_states & OPAL_PM_WINKLE_ENABLED) && 134810d91611SNicholas Piggin (supported_cpuidle_states & OPAL_PM_LOSE_FULL_CONTEXT)) 134910d91611SNicholas Piggin power7_offline_type = PNV_THREAD_WINKLE; 135010d91611SNicholas Piggin else if ((supported_cpuidle_states & OPAL_PM_SLEEP_ENABLED) || 135110d91611SNicholas Piggin (supported_cpuidle_states & OPAL_PM_SLEEP_ENABLED_ER1)) 135210d91611SNicholas Piggin power7_offline_type = PNV_THREAD_SLEEP; 135310d91611SNicholas Piggin } 135410d91611SNicholas Piggin 135510d91611SNicholas Piggin if (supported_cpuidle_states & OPAL_PM_LOSE_FULL_CONTEXT) { 135610d91611SNicholas Piggin if (pnv_save_sprs_for_deep_states()) 135710d91611SNicholas Piggin pnv_disable_deep_states(); 135810d91611SNicholas Piggin } 1359bcef83a0SShreyas B. Prabhu 1360d405a98cSShreyas B. Prabhu out: 1361d405a98cSShreyas B. Prabhu return 0; 1362d405a98cSShreyas B. Prabhu } 13634bece972SMichael Ellerman machine_subsys_initcall(powernv, pnv_init_idle_states); 1364