blob: a58083310bb083711eb465179a13f22649f613fe (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
|
// SPDX-License-Identifier: BSD-2-Clause
/*
* Copyright (C) 2017 NXP
*
* Peng Fan <peng.fan@nxp.com>
*/
#include <arm.h>
#include <arm32.h>
#include <console.h>
#include <drivers/imx_uart.h>
#include <io.h>
#include <imx.h>
#include <imx_pm.h>
#include <kernel/panic.h>
#include <kernel/cache_helpers.h>
#include <kernel/generic_boot.h>
#include <kernel/misc.h>
#include <mm/core_mmu.h>
#include <mm/core_memprot.h>
#include <sm/sm.h>
#include <sm/pm.h>
#include <sm/psci.h>
#include <stdint.h>
static int suspended_init;
int imx7_cpu_suspend(uint32_t power_state __unused, uintptr_t entry,
uint32_t context_id __unused, struct sm_nsec_ctx *nsec)
{
uint32_t suspend_ocram_base = core_mmu_get_va(TRUSTZONE_OCRAM_START +
SUSPEND_OCRAM_OFFSET,
MEM_AREA_TEE_COHERENT);
struct imx7_pm_info *p = (struct imx7_pm_info *)suspend_ocram_base;
int ret;
return 0;
if (!suspended_init) {
imx7_suspend_init();
suspended_init = 1;
}
sm_save_unbanked_regs(&nsec->ub_regs);
ret = sm_pm_cpu_suspend((uint32_t)p, (int (*)(uint32_t))
(suspend_ocram_base + sizeof(*p)));
/*
* Sometimes sm_pm_cpu_suspend may not really suspended,
* we need to check it's return value to restore reg or not
*/
if (ret < 0) {
DMSG("=== Not suspended, GPC IRQ Pending ===\n");
return 0;
}
plat_cpu_reset_late();
sm_restore_unbanked_regs(&nsec->ub_regs);
/* Set entry for back to Linux */
nsec->mon_lr = (uint32_t)entry;
main_init_gic();
DMSG("=== Back from Suspended ===\n");
return 0;
}
|
