arch/loongarch/power/hibernate.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 #include <asm/fpu.h>
   3 #include <asm/loongson.h>
   4 #include <asm/sections.h>
   5 #include <asm/tlbflush.h>
   6 #include <linux/suspend.h>
   7
   8 static u32 saved_crmd;
   9 static u32 saved_prmd;
  10 static u32 saved_euen;
  11 static u32 saved_ecfg;
  12 static u64 saved_pcpu_base;
  13 struct pt_regs saved_regs;
  14
  15 void save_processor_state(void)
  16 {
  17         saved_crmd = csr_read32(LOONGARCH_CSR_CRMD);
  18         saved_prmd = csr_read32(LOONGARCH_CSR_PRMD);
  19         saved_euen = csr_read32(LOONGARCH_CSR_EUEN);
  20         saved_ecfg = csr_read32(LOONGARCH_CSR_ECFG);
  21         saved_pcpu_base = csr_read64(PERCPU_BASE_KS);
  22
  23         if (is_fpu_owner())
  24                 save_fp(current);
  25 }
  26
  27 void restore_processor_state(void)
  28 {
  29         csr_write32(saved_crmd, LOONGARCH_CSR_CRMD);
  30         csr_write32(saved_prmd, LOONGARCH_CSR_PRMD);
  31         csr_write32(saved_euen, LOONGARCH_CSR_EUEN);
  32         csr_write32(saved_ecfg, LOONGARCH_CSR_ECFG);
  33         csr_write64(saved_pcpu_base, PERCPU_BASE_KS);
  34
  35         if (is_fpu_owner())
  36                 restore_fp(current);
  37 }
  38
  39 int pfn_is_nosave(unsigned long pfn)
  40 {
  41         unsigned long nosave_begin_pfn = PFN_DOWN(__pa(&__nosave_begin));
  42         unsigned long nosave_end_pfn = PFN_UP(__pa(&__nosave_end));
  43
  44         return  (pfn >= nosave_begin_pfn) && (pfn < nosave_end_pfn);
  45 }
  46
  47 extern int swsusp_asm_suspend(void);
  48
  49 int swsusp_arch_suspend(void)
  50 {
  51         enable_pci_wakeup();
  52         return swsusp_asm_suspend();
  53 }
  54
  55 extern int swsusp_asm_resume(void);
  56
  57 int swsusp_arch_resume(void)
  58 {
  59         /* Avoid TLB mismatch during and after kernel resume */
  60         local_flush_tlb_all();
  61         return swsusp_asm_resume();
  62 }