1// SPDX-License-Identifier: GPL-2.0 2// Copyright (C) 2008-2017 Andes Technology Corporation 3 4#include <linux/init.h> 5#include <linux/suspend.h> 6#include <linux/device.h> 7#include <linux/printk.h> 8#include <asm/suspend.h> 9#include <nds32_intrinsic.h> 10 11unsigned int resume_addr; 12unsigned int *phy_addr_sp_tmp; 13 14static void nds32_suspend2ram(void) 15{ 16 pgd_t *pgdv; 17 p4d_t *p4dv; 18 pud_t *pudv; 19 pmd_t *pmdv; 20 pte_t *ptev; 21 22 pgdv = (pgd_t *)__va((__nds32__mfsr(NDS32_SR_L1_PPTB) & 23 L1_PPTB_mskBASE)) + pgd_index((unsigned int)cpu_resume); 24 25 p4dv = p4d_offset(pgdv, (unsigned int)cpu_resume); 26 pudv = pud_offset(p4dv, (unsigned int)cpu_resume); 27 pmdv = pmd_offset(pudv, (unsigned int)cpu_resume); 28 ptev = pte_offset_map(pmdv, (unsigned int)cpu_resume); 29 30 resume_addr = ((*ptev) & TLB_DATA_mskPPN) 31 | ((unsigned int)cpu_resume & 0x00000fff); 32 33 suspend2ram(); 34} 35 36static void nds32_suspend_cpu(void) 37{ 38 while (!(__nds32__mfsr(NDS32_SR_INT_PEND) & wake_mask)) 39 __asm__ volatile ("standby no_wake_grant\n\t"); 40} 41 42static int nds32_pm_valid(suspend_state_t state) 43{ 44 switch (state) { 45 case PM_SUSPEND_ON: 46 case PM_SUSPEND_STANDBY: 47 case PM_SUSPEND_MEM: 48 return 1; 49 default: 50 return 0; 51 } 52} 53 54static int nds32_pm_enter(suspend_state_t state) 55{ 56 pr_debug("%s:state:%d\n", __func__, state); 57 switch (state) { 58 case PM_SUSPEND_STANDBY: 59 nds32_suspend_cpu(); 60 return 0; 61 case PM_SUSPEND_MEM: 62 nds32_suspend2ram(); 63 return 0; 64 default: 65 return -EINVAL; 66 } 67} 68 69static const struct platform_suspend_ops nds32_pm_ops = { 70 .valid = nds32_pm_valid, 71 .enter = nds32_pm_enter, 72}; 73 74static int __init nds32_pm_init(void) 75{ 76 pr_debug("Enter %s\n", __func__); 77 suspend_set_ops(&nds32_pm_ops); 78 return 0; 79} 80late_initcall(nds32_pm_init); 81