Quelle  pm.h   Sprache: C

/* SPDX-License-Identifier: GPL-2.0-or-later */
/*
 * Copyright (C) 2014 Imagination Technologies Ltd
 *
 * PM helper macros for CPU power off (e.g. Suspend-to-RAM).
 */

#ifndef __ASM_PM_H
#define __ASM_PM_H

#ifdef __ASSEMBLY__

#include <asm/asm-offsets.h>
#include <asm/asm.h>
#include <asm/mipsregs.h>
#include <asm/regdef.h>

/* Save CPU state to stack for suspend to RAM */
.macro SUSPEND_SAVE_REGS
 PTR_SUBU sp, PT_SIZE
 /* Call preserved GPRs */
 LONG_S $16, PT_R16(sp)
 LONG_S $17, PT_R17(sp)
 LONG_S $18, PT_R18(sp)
 LONG_S $19, PT_R19(sp)
 LONG_S $20, PT_R20(sp)
 LONG_S $21, PT_R21(sp)
 LONG_S $22, PT_R22(sp)
 LONG_S $23, PT_R23(sp)
 LONG_S $28, PT_R28(sp)
 LONG_S $30, PT_R30(sp)
 LONG_S $31, PT_R31(sp)
 /* A couple of CP0 registers with space in pt_regs */
 mfc0 k0, CP0_STATUS
 LONG_S k0, PT_STATUS(sp)
.endm

/* Restore CPU state from stack after resume from RAM */
.macro RESUME_RESTORE_REGS_RETURN
 .set push
 .set noreorder
 /* A couple of CP0 registers with space in pt_regs */
 LONG_L k0, PT_STATUS(sp)
 mtc0 k0, CP0_STATUS
 /* Call preserved GPRs */
 LONG_L $16, PT_R16(sp)
 LONG_L $17, PT_R17(sp)
 LONG_L $18, PT_R18(sp)
 LONG_L $19, PT_R19(sp)
 LONG_L $20, PT_R20(sp)
 LONG_L $21, PT_R21(sp)
 LONG_L $22, PT_R22(sp)
 LONG_L $23, PT_R23(sp)
 LONG_L $28, PT_R28(sp)
 LONG_L $30, PT_R30(sp)
 LONG_L $31, PT_R31(sp)
 /* Pop and return */
 jr ra
  PTR_ADDIU sp, PT_SIZE
 .set pop
.endm

/* Get address of static suspend state into t1 */
.macro LA_STATIC_SUSPEND
 PTR_LA t1, mips_static_suspend_state
.endm

/* Save important CPU state for early restoration to global data */
.macro SUSPEND_SAVE_STATIC
#ifdef CONFIG_EVA
 /*
 * Segment configuration is saved in global data where it can be easily
 * reloaded without depending on the segment configuration.
 */
 mfc0 k0, CP0_SEGCTL0
 LONG_S k0, SSS_SEGCTL0(t1)
 mfc0 k0, CP0_SEGCTL1
 LONG_S k0, SSS_SEGCTL1(t1)
 mfc0 k0, CP0_SEGCTL2
 LONG_S k0, SSS_SEGCTL2(t1)
#endif
 /* save stack pointer (pointing to GPRs) */
 LONG_S sp, SSS_SP(t1)
.endm

/* Restore important CPU state early from global data */
.macro RESUME_RESTORE_STATIC
#ifdef CONFIG_EVA
 /*
 * Segment configuration must be restored prior to any access to
 * allocated memory, as it may reside outside of the legacy kernel
 * segments.
 */
 LONG_L k0, SSS_SEGCTL0(t1)
 mtc0 k0, CP0_SEGCTL0
 LONG_L k0, SSS_SEGCTL1(t1)
 mtc0 k0, CP0_SEGCTL1
 LONG_L k0, SSS_SEGCTL2(t1)
 mtc0 k0, CP0_SEGCTL2
 tlbw_use_hazard
#endif
 /* restore stack pointer (pointing to GPRs) */
 LONG_L sp, SSS_SP(t1)
.endm

/* flush caches to make sure context has reached memory */
.macro SUSPEND_CACHE_FLUSH
 .extern __flush_cache_all
 .set push
 .set noreorder
 PTR_LA t1, __flush_cache_all
 LONG_L t0, 0(t1)
 jalr t0
  nop
 .set pop
 .endm

/* Save suspend state and flush data caches to RAM */
.macro SUSPEND_SAVE
 SUSPEND_SAVE_REGS
 LA_STATIC_SUSPEND
 SUSPEND_SAVE_STATIC
 SUSPEND_CACHE_FLUSH
.endm

/* Restore saved state after resume from RAM and return */
.macro RESUME_RESTORE_RETURN
 LA_STATIC_SUSPEND
 RESUME_RESTORE_STATIC
 RESUME_RESTORE_REGS_RETURN
.endm

#else /* __ASSEMBLY__ */

/**
 * struct mips_static_suspend_state - Core saved CPU state across S2R.
 * @segctl: CP0 Segment control registers.
 * @sp: Stack frame where GP register context is saved.
 *
 * This structure contains minimal CPU state that must be saved in static kernel
 * data in order to be able to restore the rest of the state. This includes
 * segmentation configuration in the case of EVA being enabled, as they must be
 * restored prior to any kmalloc'd memory being referenced (even the stack
 * pointer).
 */
struct mips_static_suspend_state {
#ifdef CONFIG_EVA
 unsigned long segctl[3];
#endif
 unsigned long sp;
};

#endif /* !__ASSEMBLY__ */

#endif /* __ASM_PM_HELPERS_H */