LXR linux/arch/nds32/kernel/pm.c

   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