blob: 3b77ab2335bd48f2fe1392e2f047839e082b86ad [file] [log] [blame]
Achin Guptae1aa5162014-06-26 09:58:52 +01001/*
Govindraj Rajaeee28e72023-08-01 15:52:40 -05002 * Copyright (c) 2014-2023, Arm Limited and Contributors. All rights reserved.
Achin Guptae1aa5162014-06-26 09:58:52 +01003 *
dp-armfa3cf0b2017-05-03 09:38:09 +01004 * SPDX-License-Identifier: BSD-3-Clause
Achin Guptae1aa5162014-06-26 09:58:52 +01005 */
6
Achin Guptae1aa5162014-06-26 09:58:52 +01007#include <asm_macros.S>
Achin Guptaf6b9e992014-07-31 11:19:11 +01008#include <assert_macros.S>
Antonio Nino Diaze0f90632018-12-14 00:18:21 +00009#include <lib/psci/psci.h>
Achin Guptae1aa5162014-06-26 09:58:52 +010010#include <platform_def.h>
11
12 .globl psci_do_pwrdown_cache_maintenance
13 .globl psci_do_pwrup_cache_maintenance
Soby Mathewd0194872016-04-29 19:01:30 +010014 .globl psci_power_down_wfi
Achin Guptae1aa5162014-06-26 09:58:52 +010015
16/* -----------------------------------------------------------------------
Soby Mathew011ca182015-07-29 17:05:03 +010017 * void psci_do_pwrdown_cache_maintenance(unsigned int power level);
Achin Guptae1aa5162014-06-26 09:58:52 +010018 *
Soby Mathew981487a2015-07-13 14:10:57 +010019 * This function performs cache maintenance for the specified power
20 * level. The levels of cache affected are determined by the power
21 * level which is passed as the argument i.e. level 0 results
22 * in a flush of the L1 cache. Both the L1 and L2 caches are flushed
23 * for a higher power level.
Achin Guptaf6b9e992014-07-31 11:19:11 +010024 *
25 * Additionally, this function also ensures that stack memory is correctly
26 * flushed out to avoid coherency issues due to a change in its memory
27 * attributes after the data cache is disabled.
Achin Guptae1aa5162014-06-26 09:58:52 +010028 * -----------------------------------------------------------------------
29 */
30func psci_do_pwrdown_cache_maintenance
31 stp x29, x30, [sp,#-16]!
32 stp x19, x20, [sp,#-16]!
33
34 /* ---------------------------------------------
Jeenu Viswambharanee5eb802016-11-18 12:58:28 +000035 * Invoke CPU-specific power down operations for
36 * the appropriate level
Achin Guptae1aa5162014-06-26 09:58:52 +010037 * ---------------------------------------------
38 */
Jeenu Viswambharanee5eb802016-11-18 12:58:28 +000039 bl prepare_cpu_pwr_dwn
Achin Guptae1aa5162014-06-26 09:58:52 +010040
41 /* ---------------------------------------------
42 * Do stack maintenance by flushing the used
43 * stack to the main memory and invalidating the
44 * remainder.
45 * ---------------------------------------------
46 */
Soby Mathew981487a2015-07-13 14:10:57 +010047 bl plat_get_my_stack
Achin Guptae1aa5162014-06-26 09:58:52 +010048
49 /* ---------------------------------------------
50 * Calculate and store the size of the used
51 * stack memory in x1.
52 * ---------------------------------------------
53 */
54 mov x19, x0
55 mov x1, sp
56 sub x1, x0, x1
57 mov x0, sp
58 bl flush_dcache_range
59
60 /* ---------------------------------------------
61 * Calculate and store the size of the unused
62 * stack memory in x1. Calculate and store the
63 * stack base address in x0.
64 * ---------------------------------------------
65 */
66 sub x0, x19, #PLATFORM_STACK_SIZE
67 sub x1, sp, x0
68 bl inv_dcache_range
69
Achin Guptae1aa5162014-06-26 09:58:52 +010070 ldp x19, x20, [sp], #16
71 ldp x29, x30, [sp], #16
72 ret
Kévin Petita877c252015-03-24 14:03:57 +000073endfunc psci_do_pwrdown_cache_maintenance
Achin Guptae1aa5162014-06-26 09:58:52 +010074
75
76/* -----------------------------------------------------------------------
77 * void psci_do_pwrup_cache_maintenance(void);
78 *
79 * This function performs cache maintenance after this cpu is powered up.
80 * Currently, this involves managing the used stack memory before turning
81 * on the data cache.
82 * -----------------------------------------------------------------------
83 */
84func psci_do_pwrup_cache_maintenance
85 stp x29, x30, [sp,#-16]!
86
87 /* ---------------------------------------------
88 * Ensure any inflight stack writes have made it
89 * to main memory.
90 * ---------------------------------------------
91 */
92 dmb st
93
94 /* ---------------------------------------------
95 * Calculate and store the size of the used
96 * stack memory in x1. Calculate and store the
97 * stack base address in x0.
98 * ---------------------------------------------
99 */
Soby Mathew981487a2015-07-13 14:10:57 +0100100 bl plat_get_my_stack
Achin Guptae1aa5162014-06-26 09:58:52 +0100101 mov x1, sp
102 sub x1, x0, x1
103 mov x0, sp
104 bl inv_dcache_range
105
106 /* ---------------------------------------------
107 * Enable the data cache.
108 * ---------------------------------------------
109 */
110 mrs x0, sctlr_el3
111 orr x0, x0, #SCTLR_C_BIT
112 msr sctlr_el3, x0
113 isb
114
115 ldp x29, x30, [sp], #16
116 ret
Kévin Petita877c252015-03-24 14:03:57 +0000117endfunc psci_do_pwrup_cache_maintenance
Soby Mathewd0194872016-04-29 19:01:30 +0100118
119/* -----------------------------------------------------------------------
120 * void psci_power_down_wfi(void);
121 * This function is called to indicate to the power controller that it
122 * is safe to power down this cpu. It should not exit the wfi and will
123 * be released from reset upon power up.
124 * -----------------------------------------------------------------------
125 */
126func psci_power_down_wfi
Harrison Mutaie5249fe2022-12-09 12:14:25 +0000127#if ERRATA_A510_2684597
128 bl apply_cpu_pwr_dwn_errata
129#endif
Soby Mathewd0194872016-04-29 19:01:30 +0100130 dsb sy // ensure write buffer empty
Harrison Mutai263c6472023-01-11 17:01:04 +00001311:
Soby Mathewd0194872016-04-29 19:01:30 +0100132 wfi
Harrison Mutai263c6472023-01-11 17:01:04 +0000133 b 1b
Soby Mathewd0194872016-04-29 19:01:30 +0100134endfunc psci_power_down_wfi