blob: 74c52c9791c713f6ded38bbc33d354646292fbe6 [file] [log] [blame]
Soby Mathewb4c6df42022-11-09 11:13:29 +00001/*
2 * SPDX-License-Identifier: BSD-3-Clause
3 * SPDX-FileCopyrightText: Copyright TF-RMM Contributors.
4 */
5
6#include <arch_helpers.h>
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00007#include <assert.h>
Soby Mathewb4c6df42022-11-09 11:13:29 +00008#include <bitmap.h>
Javier Almansa Sobrino2f717dd2024-02-12 20:49:46 +00009#include <buffer.h>
AlexeiFedorovd2e93932025-01-13 17:24:37 +000010#include <dev_granule.h>
Soby Mathewb4c6df42022-11-09 11:13:29 +000011#include <granule.h>
Soby Mathewb4c6df42022-11-09 11:13:29 +000012#include <ripas.h>
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +010013#include <s2tt.h>
14#include <s2tt_pvt_defs.h>
Soby Mathewb4c6df42022-11-09 11:13:29 +000015#include <smc.h>
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +000016#include <stdbool.h>
Soby Mathewb4c6df42022-11-09 11:13:29 +000017#include <stddef.h>
Soby Mathewb4c6df42022-11-09 11:13:29 +000018
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +000019/*
20 * Return a mask for the IPA field on a S2TTE
21 */
22static unsigned long s2tte_lvl_mask(long level, bool lpa2)
23{
24 assert(level <= S2TT_PAGE_LEVEL);
25 assert(level >= S2TT_MIN_STARTING_LEVEL_LPA2);
26
27 unsigned long mask;
28 unsigned long levels = (unsigned long)(S2TT_PAGE_LEVEL - level);
29 unsigned long lsb = (levels * S2TTE_STRIDE) + GRANULE_SHIFT;
30
31 mask = BIT_MASK_ULL((S2TTE_OA_BITS - 1U), lsb);
32
33 if (lpa2 == true) {
34 mask |= (MASK(LPA2_S2TTE_51_50) | MASK(LPA2_OA_49_48));
35 }
36
37 return mask;
38}
39
40/*
41 * Extracts the PA mapped by an S2TTE, aligned to a given level.
42 */
43static unsigned long s2tte_to_pa(unsigned long s2tte, long level, bool lpa2)
44{
45 unsigned long pa = s2tte & s2tte_lvl_mask(level, lpa2);
46
47 if (lpa2 == true) {
48 pa &= ~MASK(LPA2_S2TTE_51_50);
49 pa |= INPLACE(LPA2_OA_51_50, EXTRACT(LPA2_S2TTE_51_50, s2tte));
50 }
51
52 return pa;
53}
Soby Mathewb4c6df42022-11-09 11:13:29 +000054
55/*
56 * Invalidates S2 TLB entries from [ipa, ipa + size] region tagged with `vmid`.
57 */
Javier Almansa Sobrino2eb98b02023-12-18 18:10:55 +000058static void stage2_tlbi_ipa(const struct s2tt_context *s2_ctx,
Soby Mathewb4c6df42022-11-09 11:13:29 +000059 unsigned long ipa,
60 unsigned long size)
61{
62 /*
63 * Notes:
64 *
65 * - This follows the description provided in the Arm ARM on
66 * "Invalidation of TLB entries from stage 2 translations".
67 *
68 * - @TODO: Provide additional information to this primitive so that
69 * we can utilize:
70 * - The TTL level hint, see FEAT_TTL,
71 * - Final level lookup only invalidation,
72 * - Address range invalidation.
73 */
74
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +010075 assert(s2_ctx != NULL);
76
Soby Mathewb4c6df42022-11-09 11:13:29 +000077 /*
78 * Save the current content of vttb_el2.
79 */
80 unsigned long old_vttbr_el2 = read_vttbr_el2();
81
82 /*
83 * Make 'vmid' the `current vmid`. Note that the tlbi instructions
84 * bellow target the TLB entries that match the `current vmid`.
85 */
86 write_vttbr_el2(INPLACE(VTTBR_EL2_VMID, s2_ctx->vmid));
87 isb();
88
89 /*
90 * Invalidate entries in S2 TLB caches that
91 * match both `ipa` & the `current vmid`.
92 */
93 while (size != 0UL) {
94 tlbiipas2e1is(ipa >> 12);
95 size -= GRANULE_SIZE;
96 ipa += GRANULE_SIZE;
97 }
98 dsb(ish);
99
100 /*
101 * The architecture does not require TLB invalidation by IPA to affect
102 * combined Stage-1 + Stage-2 TLBs. Therefore we must invalidate all of
103 * Stage-1 (tagged with the `current vmid`) after invalidating Stage-2.
104 */
105 tlbivmalle1is();
106 dsb(ish);
107 isb();
108
109 /*
110 * Restore the old content of vttb_el2.
111 */
112 write_vttbr_el2(old_vttbr_el2);
113 isb();
114}
115
116/*
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100117 * Returns true if @s2tte has HIPAS=@hipas.
118 */
119static inline bool s2tte_has_hipas(unsigned long s2tte, unsigned long hipas)
120{
121 bool invalid_desc = ((s2tte & S2TT_DESC_VALID_MASK) == S2TTE_INVALID);
122 unsigned long invalid_desc_hipas = s2tte & S2TTE_INVALID_HIPAS_MASK;
123
124 return (invalid_desc && (invalid_desc_hipas == hipas));
125}
126
127/*
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000128 * Returns true if s2tte has 'output address' field, namely, if it is one of:
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000129 * - valid TTE
130 * - HIPAS = assigned
131 * - HIPAS = assigned_dev
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000132 */
133static bool s2tte_has_pa(const struct s2tt_context *s2_ctx,
134 unsigned long s2tte, long level)
135{
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100136 (void)s2_ctx;
137 (void)level;
138 bool valid_desc = ((s2tte & S2TT_DESC_VALID_MASK) == S2TTE_VALID);
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000139
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100140 return (valid_desc || /* block, page or table */
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000141 s2tte_has_hipas(s2tte, S2TTE_INVALID_HIPAS_ASSIGNED) ||
142 s2tte_has_hipas(s2tte, S2TTE_INVALID_HIPAS_ASSIGNED_DEV));
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000143}
144
145/*
146 * Creates a TTE containing only the PA.
147 * This function expects 'pa' to be aligned and bounded.
148 */
149static unsigned long pa_to_s2tte(unsigned long pa, bool lpa2)
150{
151 unsigned long tte = pa;
152
153 if (lpa2 == true) {
154 tte &= ~MASK(LPA2_OA_51_50);
155 tte |= INPLACE(LPA2_S2TTE_51_50, EXTRACT(LPA2_OA_51_50, pa));
156 }
157
158 return tte;
159}
160
161/*
Soby Mathewb4c6df42022-11-09 11:13:29 +0000162 * Invalidate S2 TLB entries with "addr" IPA.
163 * Call this function after:
164 * 1. A L3 page desc has been removed.
165 */
Javier Almansa Sobrino2eb98b02023-12-18 18:10:55 +0000166void s2tt_invalidate_page(const struct s2tt_context *s2_ctx, unsigned long addr)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000167{
168 stage2_tlbi_ipa(s2_ctx, addr, GRANULE_SIZE);
169}
170
171/*
172 * Invalidate S2 TLB entries with "addr" IPA.
173 * Call this function after:
174 * 1. A L2 block desc has been removed, or
175 * 2a. A L2 table desc has been removed, where
176 * 2b. All S2TTEs in L3 table that the L2 table desc was pointed to were invalid.
177 */
Javier Almansa Sobrino2eb98b02023-12-18 18:10:55 +0000178void s2tt_invalidate_block(const struct s2tt_context *s2_ctx, unsigned long addr)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000179{
180 stage2_tlbi_ipa(s2_ctx, addr, GRANULE_SIZE);
181}
182
183/*
184 * Invalidate S2 TLB entries with "addr" IPA.
185 * Call this function after:
186 * 1a. A L2 table desc has been removed, where
187 * 1b. Some S2TTEs in the table that the L2 table desc was pointed to were valid.
188 */
Javier Almansa Sobrino2eb98b02023-12-18 18:10:55 +0000189void s2tt_invalidate_pages_in_block(const struct s2tt_context *s2_ctx,
190 unsigned long addr)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000191{
192 stage2_tlbi_ipa(s2_ctx, addr, BLOCK_L2_SIZE);
193}
194
195/*
196 * Return the index of the entry describing @addr in the translation table at
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000197 * level @level. This only works for non-concatenated page tables, so should
Soby Mathewb4c6df42022-11-09 11:13:29 +0000198 * not be called to get the index for the starting level.
199 *
200 * See the library pseudocode
201 * aarch64/translation/vmsa_addrcalc/AArch64.TTEntryAddress on which this is
202 * modeled.
203 */
204static unsigned long s2_addr_to_idx(unsigned long addr, long level)
205{
AlexeiFedorovbb1f1c82023-08-25 10:44:49 +0100206 unsigned int levels, lsb;
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000207 unsigned int s2tte_stride = (level < S2TT_MIN_STARTING_LEVEL) ?
208 S2TTE_STRIDE_LM1 : S2TTE_STRIDE;
AlexeiFedorovbb1f1c82023-08-25 10:44:49 +0100209
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100210 levels = (unsigned int)(S2TT_PAGE_LEVEL - level);
AlexeiFedorov56e1a8e2023-09-01 17:06:13 +0100211 lsb = (levels * S2TTE_STRIDE) + GRANULE_SHIFT;
Soby Mathewb4c6df42022-11-09 11:13:29 +0000212
213 addr >>= lsb;
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000214 addr &= (1UL << s2tte_stride) - 1UL;
Soby Mathewb4c6df42022-11-09 11:13:29 +0000215 return addr;
216}
217
218/*
219 * Return the index of the entry describing @addr in the translation table
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000220 * starting level. This may return an index >= S2TTES_PER_S2TT when the
Soby Mathewb4c6df42022-11-09 11:13:29 +0000221 * combination of @start_level and @ipa_bits implies concatenated
222 * stage 2 tables.
223 *
224 * See the library pseudocode
225 * aarch64/translation/vmsa_addrcalc/AArch64.S2SLTTEntryAddress on which
226 * this is modeled.
227 */
228static unsigned long s2_sl_addr_to_idx(unsigned long addr, int start_level,
229 unsigned long ipa_bits)
230{
AlexeiFedorovbb1f1c82023-08-25 10:44:49 +0100231 unsigned int levels, lsb;
232
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100233 levels = (unsigned int)(S2TT_PAGE_LEVEL - start_level);
AlexeiFedorov56e1a8e2023-09-01 17:06:13 +0100234 lsb = (levels * S2TTE_STRIDE) + GRANULE_SHIFT;
Soby Mathewb4c6df42022-11-09 11:13:29 +0000235
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000236 addr &= ((1UL << ipa_bits) - 1UL);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000237 addr >>= lsb;
238 return addr;
239}
240
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000241static bool entry_is_table(unsigned long entry)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000242{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100243 return ((entry & S2TT_DESC_TYPE_MASK) == S2TTE_L012_TABLE);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000244}
245
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000246static unsigned long table_get_entry(const struct s2tt_context *s2_ctx,
247 struct granule *g_tbl,
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100248 unsigned long idx)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000249{
250 unsigned long *table, entry;
251
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000252 (void)s2_ctx;
253
Javier Almansa Sobrino2f717dd2024-02-12 20:49:46 +0000254 table = buffer_granule_map(g_tbl, SLOT_RTT);
AlexeiFedorov9a9062c2023-08-21 15:41:48 +0100255 assert(table != NULL);
256
Soby Mathewb4c6df42022-11-09 11:13:29 +0000257 entry = s2tte_read(&table[idx]);
258 buffer_unmap(table);
259
260 return entry;
261}
262
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000263#define table_entry_to_phys(tte, lpa2) \
264 s2tte_to_pa(tte, S2TT_PAGE_LEVEL, lpa2)
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100265
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000266static struct granule *find_next_level_idx(const struct s2tt_context *s2_ctx,
267 struct granule *g_tbl,
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100268 unsigned long idx)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000269{
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000270 assert(s2_ctx != NULL);
271
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000272 const unsigned long entry = table_get_entry(s2_ctx, g_tbl, idx);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000273
274 if (!entry_is_table(entry)) {
275 return NULL;
276 }
277
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000278 return addr_to_granule(table_entry_to_phys(entry, s2_ctx->enable_lpa2));
Soby Mathewb4c6df42022-11-09 11:13:29 +0000279}
280
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000281static struct granule *find_lock_next_level(const struct s2tt_context *s2_ctx,
282 struct granule *g_tbl,
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100283 unsigned long map_addr,
284 long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000285{
286 const unsigned long idx = s2_addr_to_idx(map_addr, level);
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000287 struct granule *g = find_next_level_idx(s2_ctx, g_tbl, idx);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000288
289 if (g != NULL) {
290 granule_lock(g, GRANULE_STATE_RTT);
291 }
292
293 return g;
294}
295
296/*
297 * Walk an RTT until level @level using @map_addr.
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000298 * @g_root is the root (level 0/-1) table and must be locked before the call.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000299 * @start_level is the initial lookup level used for the stage 2 translation
300 * tables which may depend on the configuration of the realm, factoring in the
301 * IPA size of the realm and the desired starting level (within the limits
302 * defined by the Armv8 VMSA including options for stage 2 table concatenation).
303 * The function uses hand-over-hand locking to avoid race conditions and allow
304 * concurrent access to RTT tree which is not part of the current walk; when a
305 * next level table is reached it is locked before releasing previously locked
306 * table.
307 * The walk stops when either:
308 * - The entry found is a leaf entry (not an RTT Table entry), or
309 * - Level @level is reached.
310 *
311 * On return:
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100312 * - s2tt_walk::last_level is the last level that has been reached by the walk.
313 * - s2tt_walk.g_llt points to the TABLE granule at level @s2tt_walk::level.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000314 * The granule is locked.
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000315 * - s2tt_walk::index is the entry index at s2tt_walk.g_llt for @map_addr.i
316 *
317 * NOTE: This function expects that the root table on the s2 context is
318 * already locked.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000319 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000320void s2tt_walk_lock_unlock(const struct s2tt_context *s2_ctx,
321 unsigned long map_addr,
322 long level,
323 struct s2tt_walk *wi)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000324{
Aliyha Ajmal7f9ee6e2024-10-10 10:44:17 +0100325 /* coverity[misra_c_2012_rule_11_9_violation:SUPRESS] */
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000326 struct granule *g_tbls[NR_RTT_LEVELS_LPA2] = { (struct granule *)NULL };
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000327 struct granule *g_root;
328 unsigned long sl_idx, ipa_bits;
329 int i, start_level, last_level;
Soby Mathewb4c6df42022-11-09 11:13:29 +0000330
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000331 assert(s2_ctx != NULL);
332
333 start_level = s2_ctx->s2_starting_level;
334 ipa_bits = s2_ctx->ipa_bits;
335
Soby Mathewb4c6df42022-11-09 11:13:29 +0000336 assert(level >= start_level);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100337 assert(level <= S2TT_PAGE_LEVEL);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000338 assert(map_addr < (1UL << ipa_bits));
339 assert(wi != NULL);
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000340
Javier Almansa Sobrino6e3b5522024-04-10 12:12:13 +0100341 if (s2_ctx->enable_lpa2 == true) {
342 assert(ipa_bits <= S2TTE_OA_BITS_LPA2);
343 } else {
344 assert(ipa_bits <= S2TTE_OA_BITS);
345 }
346
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000347 g_root = s2_ctx->g_rtt;
Soby Mathewb4c6df42022-11-09 11:13:29 +0000348
349 /* Handle concatenated starting level (SL) tables */
350 sl_idx = s2_sl_addr_to_idx(map_addr, start_level, ipa_bits);
351 if (sl_idx >= S2TTES_PER_S2TT) {
AlexeiFedorov4faab852023-08-30 15:06:49 +0100352 unsigned int tt_num = (unsigned int)(sl_idx >> S2TTE_STRIDE);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100353 struct granule *g_concat_root;
354
Javier Almansa Sobrino6e3b5522024-04-10 12:12:13 +0100355 assert(tt_num < s2_ctx->num_root_rtts);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100356
357 g_concat_root = (struct granule *)((uintptr_t)g_root +
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000358 (tt_num * sizeof(struct granule)));
Soby Mathewb4c6df42022-11-09 11:13:29 +0000359
360 granule_lock(g_concat_root, GRANULE_STATE_RTT);
361 granule_unlock(g_root);
362 g_root = g_concat_root;
363 }
364
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000365 /* 'start_level' can be '-1', so add 1 when used as an index */
366 g_tbls[start_level + 1] = g_root;
Soby Mathewb4c6df42022-11-09 11:13:29 +0000367 for (i = start_level; i < level; i++) {
368 /*
369 * Lock next RTT level. Correct locking order is guaranteed
370 * because reference is obtained from a locked granule
371 * (previous level). Also, hand-over-hand locking/unlocking is
372 * used to avoid race conditions.
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000373 *
374 * Note that as 'start_level' can be -1, we add '1' to the
375 * index 'i' to compensate for the negative value when we
376 * use it to index then 'g_tbls' list.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000377 */
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000378 g_tbls[i + 1 + 1] = find_lock_next_level(s2_ctx, g_tbls[i + 1],
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000379 map_addr, i);
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000380 if (g_tbls[i + 1 + 1] == NULL) {
Soby Mathewb4c6df42022-11-09 11:13:29 +0000381 last_level = i;
382 goto out;
383 }
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000384 granule_unlock(g_tbls[i + 1]);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000385 }
386
AlexeiFedorov4faab852023-08-30 15:06:49 +0100387 last_level = (int)level;
Soby Mathewb4c6df42022-11-09 11:13:29 +0000388out:
389 wi->last_level = last_level;
AlexeiFedorove956db32024-04-04 14:36:21 +0100390 /* coverity[deref_overflow:SUPPRESS] */
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000391 wi->g_llt = g_tbls[last_level + 1];
Soby Mathewb4c6df42022-11-09 11:13:29 +0000392 wi->index = s2_addr_to_idx(map_addr, last_level);
393}
394
395/*
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100396 * Creates an unassigned_empty s2tte.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000397 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000398unsigned long s2tte_create_unassigned_empty(const struct s2tt_context *s2_ctx)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000399{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000400 (void)s2_ctx;
401
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100402 return (S2TTE_INVALID_HIPAS_UNASSIGNED | S2TTE_INVALID_RIPAS_EMPTY);
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100403}
404
405/*
406 * Creates an unassigned_ram s2tte.
407 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000408unsigned long s2tte_create_unassigned_ram(const struct s2tt_context *s2_ctx)
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100409{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000410 (void)s2_ctx;
411
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100412 return (S2TTE_INVALID_HIPAS_UNASSIGNED | S2TTE_INVALID_RIPAS_RAM);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000413}
414
415/*
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100416 * Creates an unassigned_destroyed s2tte.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000417 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000418unsigned long s2tte_create_unassigned_destroyed(const struct s2tt_context *s2_ctx)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000419{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000420 (void)s2_ctx;
421
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100422 return (S2TTE_INVALID_HIPAS_UNASSIGNED | S2TTE_INVALID_RIPAS_DESTROYED);
423}
424
425/*
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100426 * Creates an unassigned_ns s2tte.
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100427 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000428unsigned long s2tte_create_unassigned_ns(const struct s2tt_context *s2_ctx)
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100429{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000430 (void)s2_ctx;
431
Javier Almansa Sobrino6e3b5522024-04-10 12:12:13 +0100432 return (S2TTE_NS | S2TTE_INVALID_HIPAS_UNASSIGNED);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000433}
434
435/*
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000436 * Creates s2tte with output address @pa, HIPAS=ASSIGNED and
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100437 * RIPAS=@s2tte_ripas, at level @level.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000438 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000439static unsigned long s2tte_create_assigned(const struct s2tt_context *s2_ctx,
440 unsigned long pa, long level,
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100441 unsigned long s2tte_ripas)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000442{
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100443 unsigned long tte;
444
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000445 assert(s2_ctx != NULL);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100446 assert(level >= S2TT_MIN_BLOCK_LEVEL);
447 assert(level <= S2TT_PAGE_LEVEL);
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000448 assert(s2tte_ripas <= S2TTE_INVALID_RIPAS_DESTROYED);
Javier Almansa Sobrino6e3b5522024-04-10 12:12:13 +0100449 assert(s2tte_is_addr_lvl_aligned(s2_ctx, pa, level));
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000450
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100451 tte = pa_to_s2tte(pa, s2_ctx->enable_lpa2);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100452
453 if (s2tte_ripas == S2TTE_INVALID_RIPAS_RAM) {
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100454 unsigned long s2tte_page, s2tte_block;
455
456 if (s2_ctx->enable_lpa2) {
457 s2tte_page = S2TTE_PAGE_LPA2;
458 s2tte_block = S2TTE_BLOCK_LPA2;
459 } else {
460 s2tte_page = S2TTE_PAGE;
461 s2tte_block = S2TTE_BLOCK;
462 }
463
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100464 if (level == S2TT_PAGE_LEVEL) {
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000465 return (tte | s2tte_page);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100466 }
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000467 return (tte | s2tte_block);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100468 }
469
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000470 return (tte | S2TTE_INVALID_HIPAS_ASSIGNED | s2tte_ripas);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100471}
472
473/*
474 * Creates and invalid s2tte with output address @pa, HIPAS=ASSIGNED and
475 * RIPAS=DESTROYED at level @level.
476 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000477unsigned long s2tte_create_assigned_destroyed(const struct s2tt_context *s2_ctx,
478 unsigned long pa, long level)
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100479{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000480 return s2tte_create_assigned(s2_ctx, pa, level,
481 S2TTE_INVALID_RIPAS_DESTROYED);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100482}
483
484/*
485 * Creates an invalid s2tte with output address @pa, HIPAS=ASSIGNED and
486 * RIPAS=EMPTY at level @level.
487 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000488unsigned long s2tte_create_assigned_empty(const struct s2tt_context *s2_ctx,
489 unsigned long pa, long level)
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100490{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000491 return s2tte_create_assigned(s2_ctx, pa, level,
492 S2TTE_INVALID_RIPAS_EMPTY);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000493}
494
495/*
AlexeiFedorov3a739332023-04-13 13:54:04 +0100496 * Creates an assigned_ram s2tte with output address @pa.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000497 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000498unsigned long s2tte_create_assigned_ram(const struct s2tt_context *s2_ctx,
499 unsigned long pa, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000500{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000501 return s2tte_create_assigned(s2_ctx, pa, level,
502 S2TTE_INVALID_RIPAS_RAM);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000503}
504
505/*
Javier Almansa Sobrino84a1b162023-09-26 17:32:44 +0100506 * Creates an assigned s2tte with output address @pa and the same
507 * RIPAS as passed on @s2tte.
508 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000509unsigned long s2tte_create_assigned_unchanged(const struct s2tt_context *s2_ctx,
510 unsigned long s2tte,
Javier Almansa Sobrino84a1b162023-09-26 17:32:44 +0100511 unsigned long pa,
512 long level)
513{
514 unsigned long current_ripas = s2tte & S2TTE_INVALID_RIPAS_MASK;
515
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000516 assert((s2tte & S2TT_DESC_VALID_MASK) == S2TTE_INVALID);
517
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000518 return s2tte_create_assigned(s2_ctx, pa, level, current_ripas);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000519}
520
521/*
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000522 * Creates an invalid s2tte with output address @pa, HIPAS=ASSIGNED_DEV and
523 * RIPAS=@s2tte_ripas, at level @level.
524 * This function is only called for @s2tte_ripas values corresponding to
525 * RIPAS_EMPTY and RIPAS_DESTROYED.
526 */
527static unsigned long s2tte_create_assigned_dev(const struct s2tt_context *s2_ctx,
528 unsigned long pa, long level,
529 unsigned long s2tte_ripas)
530{
531 (void)level;
532 unsigned long tte;
533
534 assert(s2_ctx != NULL);
535 assert(level >= S2TT_MIN_DEV_BLOCK_LEVEL);
536 assert((s2tte_ripas == S2TTE_INVALID_RIPAS_EMPTY) ||
537 (s2tte_ripas == S2TTE_INVALID_RIPAS_DESTROYED));
538 assert(s2tte_is_addr_lvl_aligned(s2_ctx, pa, level));
539
540 tte = pa_to_s2tte(pa, s2_ctx->enable_lpa2);
541
542 return (tte | S2TTE_INVALID_HIPAS_ASSIGNED_DEV | s2tte_ripas);
543}
544
545/*
546 * Creates an invalid s2tte with output address @pa, HIPAS=ASSIGNED_DEV
547 * and RIPAS=EMPTY, at level @level.
548 */
549unsigned long s2tte_create_assigned_dev_empty(const struct s2tt_context *s2_ctx,
550 unsigned long pa, long level)
551{
552 return s2tte_create_assigned_dev(s2_ctx, pa, level,
553 S2TTE_INVALID_RIPAS_EMPTY);
554}
555
556/*
557 * Creates an invalid s2tte with output address @pa, HIPAS=ASSIGNED_DEV and
558 * RIPAS=DESTROYED, at level @level.
559 */
560unsigned long s2tte_create_assigned_dev_destroyed(const struct s2tt_context *s2_ctx,
561 unsigned long pa, long level)
562{
563 return s2tte_create_assigned_dev(s2_ctx, pa, level,
564 S2TTE_INVALID_RIPAS_DESTROYED);
565}
566
567/*
568 * Creates an dev_assigned s2tte with output address @pa and the same
569 * RIPAS as passed on @s2tte.
570 */
571unsigned long s2tte_create_assigned_dev_unchanged(const struct s2tt_context *s2_ctx,
572 unsigned long s2tte,
573 unsigned long pa,
574 long level)
575{
576 unsigned long current_ripas = s2tte & S2TTE_INVALID_RIPAS_MASK;
577
578 assert((s2tte & S2TT_DESC_VALID_MASK) == S2TTE_INVALID);
579
580 return s2tte_create_assigned_dev(s2_ctx, pa, level, current_ripas);
581}
582
583/*
584 * Creates a valid assigned_dev_dev s2tte at @level with attributes passed in
585 * @attr.
586 */
587static unsigned long create_assigned_dev_dev_attr(unsigned long s2tte,
588 unsigned long attr, long level,
589 bool lpa2)
590{
591 unsigned long pa, new_s2tte;
592
593 assert(level >= S2TT_MIN_DEV_BLOCK_LEVEL);
594
595 pa = s2tte_to_pa(s2tte, level, lpa2);
596
597 new_s2tte = attr | pa_to_s2tte(pa, lpa2);
598
599 if (level == S2TT_PAGE_LEVEL) {
600 return (new_s2tte | S2TTE_L3_PAGE);
601 }
602
603 return (new_s2tte | S2TTE_L012_BLOCK);
604}
605
606/*
607 * Creates a valid assigned_dev_dev s2tte at @level with attributes passed in
608 * @s2tte.
609 */
610unsigned long s2tte_create_assigned_dev_dev(const struct s2tt_context *s2_ctx,
611 unsigned long s2tte, long level)
612{
613 unsigned long s2tte_mask = (S2TTE_DEV_ATTRS_MASK | S2TTE_MEMATTR_MASK);
614 unsigned long attr;
615 bool lpa2;
616
617 assert(s2_ctx != NULL);
618
619 lpa2 = s2_ctx->enable_lpa2;
620
621 /* Add Shareability bits if FEAT_LPA2 is not enabled */
622 if (!lpa2) {
623 s2tte_mask |= S2TTE_SH_MASK;
624 }
625
626 /* Get attributes */
627 attr = s2tte & s2tte_mask;
628
629 return create_assigned_dev_dev_attr(s2tte, attr, level, lpa2);
630}
631
632/*
633 * Creates a valid assigned_dev_dev s2tte at @level with attributes based on
634 * device coherency passed in @type.
635 */
636unsigned long s2tte_create_assigned_dev_dev_coh_type(const struct s2tt_context *s2_ctx,
637 unsigned long s2tte, long level,
638 enum dev_coh_type type)
639{
640 unsigned long attr;
641 bool lpa2;
642
643 assert(s2_ctx != NULL);
644 assert(type < DEV_MEM_MAX);
645
646 lpa2 = s2_ctx->enable_lpa2;
647
648 if (type == DEV_MEM_COHERENT) {
649 /* Coherent device */
650 attr = S2TTE_DEV_COH_ATTRS;
651
652 /* Add Shareability bits if FEAT_LPA2 is not enabled */
653 if (!lpa2) {
654 attr |= S2TTE_SH_IS; /* Inner Shareable */
655 }
656 } else {
657 /* Non-coherent device */
658 attr = S2TTE_DEV_NCOH_ATTRS;
659
660 /* Add Shareability bits if FEAT_LPA2 is not enabled */
661 if (!lpa2) {
662 attr |= S2TTE_SH_OS; /* Outer Shareable */
663 }
664 }
665
666 return create_assigned_dev_dev_attr(s2tte, attr, level, lpa2);
667}
668
669/*
AlexeiFedorov3a739332023-04-13 13:54:04 +0100670 * Creates an assigned_ns s2tte at level @level.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000671 *
672 * The following S2 TTE fields are provided through @s2tte argument:
673 * - The physical address
674 * - MemAttr
675 * - S2AP
Soby Mathewb4c6df42022-11-09 11:13:29 +0000676 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000677unsigned long s2tte_create_assigned_ns(const struct s2tt_context *s2_ctx,
678 unsigned long s2tte, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000679{
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000680 /*
Soby Mathew217748d2024-10-02 11:02:19 +0100681 * We just mask out the DESC_TYPE below. We assume rest of the
682 * bits have been setup properly by the caller.
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000683 */
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100684 unsigned long new_s2tte = s2tte & ~S2TT_DESC_TYPE_MASK;
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000685
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100686 assert(s2_ctx != NULL);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100687 assert(level >= S2TT_MIN_BLOCK_LEVEL);
688 assert(level <= S2TT_PAGE_LEVEL);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100689
Soby Mathew217748d2024-10-02 11:02:19 +0100690 /* The Shareability bits need to be added if FEAT_LPA2 is not enabled */
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100691 if (!s2_ctx->enable_lpa2) {
Soby Mathew217748d2024-10-02 11:02:19 +0100692 new_s2tte |= S2TTE_SH_IS;
693 }
694
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100695 if (level == S2TT_PAGE_LEVEL) {
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +0100696 return (new_s2tte | S2TTE_PAGE_NS);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000697 }
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +0100698 return (new_s2tte | S2TTE_BLOCK_NS);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000699}
700
701/*
702 * Validate the portion of NS S2TTE that is provided by the host.
703 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000704bool host_ns_s2tte_is_valid(const struct s2tt_context *s2_ctx,
705 unsigned long s2tte, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000706{
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000707 bool lpa2;
708 unsigned long mask;
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100709
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000710 assert(s2_ctx != NULL);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100711 assert(level >= S2TT_MIN_BLOCK_LEVEL);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000712
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000713 lpa2 = s2_ctx->enable_lpa2;
714
Soby Mathew217748d2024-10-02 11:02:19 +0100715 mask = s2tte_lvl_mask(level, lpa2) | S2TTE_NS_ATTR_MASK;
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000716
Soby Mathewb4c6df42022-11-09 11:13:29 +0000717 /*
718 * Test that all fields that are not controlled by the host are zero
719 * and that the output address is correctly aligned. Note that
720 * the host is permitted to map any physical address outside PAR.
Shruti Gupta3530a712024-09-12 10:50:21 +0100721 * Note that this also checks for the case when FEAT_LPA2 is disabled
722 * for the Realm, then the PA in `s2tte` must be <= 48 bits wide.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000723 */
724 if ((s2tte & ~mask) != 0UL) {
725 return false;
726 }
727
728 /*
729 * Only one value masked by S2TTE_MEMATTR_MASK is invalid/reserved.
730 */
731 if ((s2tte & S2TTE_MEMATTR_MASK) == S2TTE_MEMATTR_FWB_RESERVED) {
732 return false;
733 }
734
735 /*
Soby Mathewb4c6df42022-11-09 11:13:29 +0000736 * Note that all the values that are masked by S2TTE_AP_MASK are valid.
737 */
738 return true;
739}
740
741/*
742 * Returns the portion of NS S2TTE that is set by the host.
743 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000744unsigned long host_ns_s2tte(const struct s2tt_context *s2_ctx,
745 unsigned long s2tte, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000746{
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000747 assert(s2_ctx != NULL);
748
Soby Mathew217748d2024-10-02 11:02:19 +0100749 unsigned long mask = s2tte_lvl_mask(level, s2_ctx->enable_lpa2)
750 | S2TTE_NS_ATTR_MASK;
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000751
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100752 assert(level >= S2TT_MIN_BLOCK_LEVEL);
753
Soby Mathewb4c6df42022-11-09 11:13:29 +0000754 return (s2tte & mask);
755}
756
757/*
758 * Creates a table s2tte at level @level with output address @pa.
759 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000760unsigned long s2tte_create_table(const struct s2tt_context *s2_ctx,
761 unsigned long pa, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000762{
Chuyue Luo5ef71d92023-10-24 14:29:20 +0100763 (void)level;
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000764 __unused long min_starting_level;
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000765
766 assert(s2_ctx != NULL);
Shruti Gupta0a0d4ee2024-04-22 21:37:25 +0100767
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100768 min_starting_level = s2_ctx->enable_lpa2 ?
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000769 S2TT_MIN_STARTING_LEVEL_LPA2 : S2TT_MIN_STARTING_LEVEL;
Chuyue Luo5ef71d92023-10-24 14:29:20 +0100770
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100771 assert(level < S2TT_PAGE_LEVEL);
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000772 assert(level >= min_starting_level);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000773 assert(GRANULE_ALIGNED(pa));
774
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +0000775 return (pa_to_s2tte(pa, s2_ctx->enable_lpa2) | S2TTE_TABLE);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000776}
777
778/*
AlexeiFedorova018c2e2025-04-07 11:36:54 +0100779 * Returns true if s2tte has defined RIPAS value, namely if it is one of:
AlexeiFedorov0fb44552023-04-14 15:37:58 +0100780 * - unassigned_empty
781 * - unassigned_ram
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100782 * - unassigned_destroyed
AlexeiFedorov0fb44552023-04-14 15:37:58 +0100783 * - assigned_empty
784 * - assigned_ram
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100785 * - assigned_destroyed
AlexeiFedorov0fb44552023-04-14 15:37:58 +0100786 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000787bool s2tte_has_ripas(const struct s2tt_context *s2_ctx,
788 unsigned long s2tte, long level)
AlexeiFedorov0fb44552023-04-14 15:37:58 +0100789{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000790 return (((s2tte & S2TTE_NS) == 0UL) && !s2tte_is_table(s2_ctx,
791 s2tte, level));
AlexeiFedorov0fb44552023-04-14 15:37:58 +0100792}
793
794/*
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100795 * Returns true if @s2tte has HIPAS=UNASSIGNED and RIPAS=@ripas.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000796 */
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100797static inline bool s2tte_has_unassigned_ripas(unsigned long s2tte,
798 unsigned long ripas)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000799{
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100800 return (((s2tte & S2TTE_INVALID_RIPAS_MASK) == ripas) &&
801 s2tte_has_hipas(s2tte, S2TTE_INVALID_HIPAS_UNASSIGNED));
802}
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100803
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100804/*
805 * Returns true if @s2tte has HIPAS=ASSIGNED and RIPAS=@ripas.
806 */
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100807static inline bool s2tte_has_assigned_ripas(unsigned long s2tte,
808 unsigned long ripas)
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100809{
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000810 assert((s2tte & S2TT_DESC_VALID_MASK) == S2TTE_INVALID);
811 assert(ripas != S2TTE_INVALID_RIPAS_RAM);
812
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100813 return (((s2tte & S2TTE_INVALID_RIPAS_MASK) == ripas) &&
814 s2tte_has_hipas(s2tte, S2TTE_INVALID_HIPAS_ASSIGNED));
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100815}
816
817/*
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000818 * Returns true if @s2tte has HIPAS=ASSIGNED_DEV and RIPAS=@ripas.
819 */
820static bool s2tte_has_assigned_dev_ripas(unsigned long s2tte, unsigned long ripas)
821{
822 assert((s2tte & S2TT_DESC_VALID_MASK) == S2TTE_INVALID);
823 assert(ripas != S2TTE_INVALID_RIPAS_DEV);
824
825 return ((s2tte & S2TTE_INVALID_RIPAS_MASK) == ripas) &&
826 s2tte_has_hipas(s2tte, S2TTE_INVALID_HIPAS_ASSIGNED_DEV);
827}
828
829/*
AlexeiFedorov0f9cd1f2023-07-10 17:04:58 +0100830 * Returns true if @s2tte has HIPAS=UNASSIGNED.
831 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000832bool s2tte_is_unassigned(const struct s2tt_context *s2_ctx, unsigned long s2tte)
AlexeiFedorov0f9cd1f2023-07-10 17:04:58 +0100833{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000834 (void)s2_ctx;
835
AlexeiFedorov0f9cd1f2023-07-10 17:04:58 +0100836 return s2tte_has_hipas(s2tte, S2TTE_INVALID_HIPAS_UNASSIGNED);
837}
838
839/*
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100840 * Returns true if @s2tte is an unassigned_empty.
841 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000842bool s2tte_is_unassigned_empty(const struct s2tt_context *s2_ctx,
843 unsigned long s2tte)
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100844{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000845 (void)s2_ctx;
846
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100847 return (((s2tte & S2TTE_NS) == 0UL) &&
848 s2tte_has_unassigned_ripas(s2tte, S2TTE_INVALID_RIPAS_EMPTY));
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100849}
850
851/*
852 * Returns true if @s2tte is an unassigned_ram.
853 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000854bool s2tte_is_unassigned_ram(const struct s2tt_context *s2_ctx,
855 unsigned long s2tte)
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100856{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000857 (void)s2_ctx;
858
AlexeiFedorovc07a6382023-04-14 11:59:18 +0100859 return s2tte_has_unassigned_ripas(s2tte, S2TTE_INVALID_RIPAS_RAM);
860}
861
862/*
AlexeiFedorov5ceff352023-04-12 16:17:00 +0100863 * Returns true if @s2tte is unassigned_ns.
864 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000865bool s2tte_is_unassigned_ns(const struct s2tt_context *s2_ctx,
866 unsigned long s2tte)
AlexeiFedorov5ceff352023-04-12 16:17:00 +0100867{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000868 (void)s2_ctx;
869
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100870 return (((s2tte & S2TTE_NS) != 0UL) &&
871 s2tte_has_hipas(s2tte, S2TTE_INVALID_HIPAS_UNASSIGNED));
Soby Mathewb4c6df42022-11-09 11:13:29 +0000872}
873
874/*
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100875 * Returns true if @s2tte has RIPAS=DESTROYED.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000876 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000877bool s2tte_is_unassigned_destroyed(const struct s2tt_context *s2_ctx,
878 unsigned long s2tte)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000879{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000880 (void)s2_ctx;
881
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100882 return s2tte_has_unassigned_ripas(s2tte, S2TTE_INVALID_RIPAS_DESTROYED);
883}
884
885/*
886 * Returns true if @s2tte is an assigned_destroyed.
887 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000888bool s2tte_is_assigned_destroyed(const struct s2tt_context *s2_ctx,
889 unsigned long s2tte, long level)
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100890{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000891 (void)s2_ctx;
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000892 (void)level;
893
894 if ((s2tte & S2TT_DESC_VALID_MASK) != S2TTE_INVALID) {
895 return false;
896 }
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100897
898 return s2tte_has_assigned_ripas(s2tte, S2TTE_INVALID_RIPAS_DESTROYED);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000899}
900
901/*
AlexeiFedorov3a739332023-04-13 13:54:04 +0100902 * Returns true if @s2tte is an assigned_empty.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000903 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000904bool s2tte_is_assigned_empty(const struct s2tt_context *s2_ctx,
905 unsigned long s2tte, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000906{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000907 (void)s2_ctx;
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000908 (void)level;
909
910 if ((s2tte & S2TT_DESC_VALID_MASK) != S2TTE_INVALID) {
911 return false;
912 }
Soby Mathewb4c6df42022-11-09 11:13:29 +0000913
AlexeiFedorovc53b1f72023-07-04 15:37:03 +0100914 return s2tte_has_assigned_ripas(s2tte, S2TTE_INVALID_RIPAS_EMPTY);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000915}
916
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000917static bool s2tte_check(const struct s2tt_context *s2_ctx, unsigned long s2tte,
918 long level, unsigned long ns)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000919{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000920 (void)s2_ctx;
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000921 unsigned long desc_type;
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000922
Soby Mathewb4c6df42022-11-09 11:13:29 +0000923 if ((s2tte & S2TTE_NS) != ns) {
924 return false;
925 }
926
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +0100927 desc_type = s2tte & S2TT_DESC_TYPE_MASK;
Soby Mathewb4c6df42022-11-09 11:13:29 +0000928
Shruti Gupta3105c3f2024-02-26 14:06:11 +0000929 /* Only pages at L3 and valid blocks at L2 and L1 allowed */
Javier Almansa Sobrino6e3b5522024-04-10 12:12:13 +0100930 if (level == S2TT_PAGE_LEVEL) {
931 return (desc_type == S2TTE_L3_PAGE);
932 }
933
934 if ((level >= S2TT_MIN_BLOCK_LEVEL) && (desc_type == S2TTE_L012_BLOCK)) {
Soby Mathewb4c6df42022-11-09 11:13:29 +0000935 return true;
936 }
937
938 return false;
939}
940
941/*
AlexeiFedorov3a739332023-04-13 13:54:04 +0100942 * Returns true if @s2tte is an assigned_ram.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000943 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000944bool s2tte_is_assigned_ram(const struct s2tt_context *s2_ctx,
945 unsigned long s2tte, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000946{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000947 return s2tte_check(s2_ctx, s2tte, level, 0UL);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000948}
949
950/*
AlexeiFedorov3a739332023-04-13 13:54:04 +0100951 * Returns true if @s2tte is an assigned_ns s2tte.
Soby Mathewb4c6df42022-11-09 11:13:29 +0000952 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000953bool s2tte_is_assigned_ns(const struct s2tt_context *s2_ctx,
954 unsigned long s2tte, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +0000955{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +0000956 return s2tte_check(s2_ctx, s2tte, level, S2TTE_NS);
Soby Mathewb4c6df42022-11-09 11:13:29 +0000957}
958
959/*
AlexeiFedorovd2e93932025-01-13 17:24:37 +0000960 * Returns true if @s2tte has HIPAS=ASSIGNED_DEV and RIPAS=RIPAS_DEV.
961 */
962bool s2tte_is_assigned_dev_dev(const struct s2tt_context *s2_ctx,
963 unsigned long s2tte, long level)
964{
965 unsigned long attr;
966 unsigned long desc_type = s2tte & S2TT_DESC_TYPE_MASK;
967 bool lpa2;
968
969 assert(s2_ctx != NULL);
970
971 /* Only pages at L3 and valid blocks at L2 allowed */
972 if (!(((level == S2TT_PAGE_LEVEL) && (desc_type == S2TTE_L3_PAGE)) ||
973 ((level == S2TT_MIN_DEV_BLOCK_LEVEL) && (desc_type == S2TTE_L012_BLOCK)))) {
974 return false;
975 }
976
977 attr = s2tte & (S2TTE_DEV_ATTRS_MASK | S2TTE_MEMATTR_MASK);
978 lpa2 = s2_ctx->enable_lpa2;
979
980 /*
981 * Check that NS, XN, S2AP, AF and MemAttr[3:0] match with provided
982 * attributes. When LPA2 is not enabled, assert if shareability
983 * attrubutes are not set correctly.
984 */
985 if (attr == S2TTE_DEV_COH_ATTRS) {
986 if (!lpa2) {
987 /* Coherent device, Inner Shareable */
988 assert((s2tte & S2TTE_SH_MASK) == S2TTE_SH_IS);
989 }
990 return true;
991 } else if (attr == S2TTE_DEV_NCOH_ATTRS) {
992 if (!lpa2) {
993 /* Non-coherent device, Outer Shareable */
994 assert((s2tte & S2TTE_SH_MASK) == S2TTE_SH_OS);
995 }
996 return true;
997 }
998 return false;
999}
1000
1001/*
1002 * Returns true if @s2tte has HIPAS=ASSIGNED_DEV and RIPAS=RIPAS_EMPTY.
1003 */
1004bool s2tte_is_assigned_dev_empty(const struct s2tt_context *s2_ctx,
1005 unsigned long s2tte, long level)
1006{
1007 (void)s2_ctx;
1008 (void)level;
1009
1010 if ((s2tte & S2TT_DESC_VALID_MASK) != S2TTE_INVALID) {
1011 return false;
1012 }
1013
1014 return s2tte_has_assigned_dev_ripas(s2tte, S2TTE_INVALID_RIPAS_EMPTY);
1015}
1016
1017/*
1018 * Returns true if @s2tte is an dev_assigned_destroyed.
1019 */
1020bool s2tte_is_assigned_dev_destroyed(const struct s2tt_context *s2_ctx,
1021 unsigned long s2tte, long level)
1022{
1023 (void)s2_ctx;
1024 (void)level;
1025
1026 if ((s2tte & S2TT_DESC_VALID_MASK) != S2TTE_INVALID) {
1027 return false;
1028 }
1029
1030 return s2tte_has_assigned_dev_ripas(s2tte, S2TTE_INVALID_RIPAS_DESTROYED);
1031}
1032
1033/*
Soby Mathewb4c6df42022-11-09 11:13:29 +00001034 * Returns true if @s2tte is a table at level @level.
1035 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001036bool s2tte_is_table(const struct s2tt_context *s2_ctx, unsigned long s2tte,
1037 long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001038{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001039 (void)s2_ctx;
1040
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001041 return ((level < S2TT_PAGE_LEVEL) &&
1042 ((s2tte & S2TT_DESC_TYPE_MASK) == S2TTE_L012_TABLE));
Soby Mathewb4c6df42022-11-09 11:13:29 +00001043}
1044
1045/*
1046 * Returns RIPAS of @s2tte.
1047 *
1048 * Caller should ensure that HIPAS=UNASSIGNED or HIPAS=ASSIGNED.
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001049 * The s2tte, if valid, should correspond to RIPAS_RAM.
Soby Mathewb4c6df42022-11-09 11:13:29 +00001050 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001051enum ripas s2tte_get_ripas(const struct s2tt_context *s2_ctx, unsigned long s2tte)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001052{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001053 (void)s2_ctx;
AlexeiFedorova018c2e2025-04-07 11:36:54 +01001054 unsigned long desc_ripas = s2tte & S2TTE_INVALID_RIPAS_MASK;
1055 bool valid_desc = ((s2tte & S2TT_DESC_VALID_MASK) == S2TTE_VALID);
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001056
Soby Mathewb4c6df42022-11-09 11:13:29 +00001057 /*
Javier Almansa Sobrinob802a0e2024-07-05 12:52:23 +01001058 * If a valid S2TTE descriptor is passed, the RIPAS corresponds to
1059 * RIPAS_RAM.
Soby Mathewb4c6df42022-11-09 11:13:29 +00001060 */
AlexeiFedorova018c2e2025-04-07 11:36:54 +01001061 if (valid_desc) {
1062 __unused unsigned long desc_type = s2tte & S2TT_DESC_TYPE_MASK;
1063
Javier Almansa Sobrinob802a0e2024-07-05 12:52:23 +01001064 assert((desc_type == S2TTE_L012_BLOCK) ||
1065 (desc_type == S2TTE_L3_PAGE));
1066 return RIPAS_RAM;
1067 }
Soby Mathewb4c6df42022-11-09 11:13:29 +00001068
Javier Almansa Sobrinob802a0e2024-07-05 12:52:23 +01001069 assert(EXTRACT(S2TTE_INVALID_HIPAS, s2tte) <= RMI_ASSIGNED);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001070
1071 desc_ripas = desc_ripas >> S2TTE_INVALID_RIPAS_SHIFT;
1072
1073 assert(desc_ripas <= (unsigned int)RIPAS_DESTROYED);
1074
1075 return (enum ripas)desc_ripas;
Soby Mathewb4c6df42022-11-09 11:13:29 +00001076}
1077
1078/*
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001079 * Populates @s2tt with unassigned_empty s2ttes.
Soby Mathewb4c6df42022-11-09 11:13:29 +00001080 *
1081 * The granule is populated before it is made a table,
1082 * hence, don't use s2tte_write for access.
1083 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001084void s2tt_init_unassigned_empty(const struct s2tt_context *s2_ctx,
1085 unsigned long *s2tt)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001086{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001087 unsigned long s2tte =
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001088 s2tte_create_unassigned_empty(s2_ctx);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001089
AlexeiFedorovd2e93932025-01-13 17:24:37 +00001090 assert(s2tt != NULL);
1091
Soby Mathewb4c6df42022-11-09 11:13:29 +00001092 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001093 s2tt[i] = s2tte;
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001094 }
1095
1096 dsb(ish);
1097}
1098
1099/*
1100 * Populates @s2tt with unassigned_ram s2ttes.
1101 *
1102 * The granule is populated before it is made a table,
1103 * hence, don't use s2tte_write for access.
1104 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001105void s2tt_init_unassigned_ram(const struct s2tt_context *s2_ctx,
1106 unsigned long *s2tt)
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001107{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001108 unsigned long s2tte = s2tte_create_unassigned_ram(s2_ctx);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001109
AlexeiFedorovd2e93932025-01-13 17:24:37 +00001110 assert(s2tt != NULL);
1111
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001112 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001113 s2tt[i] = s2tte;
Soby Mathewb4c6df42022-11-09 11:13:29 +00001114 }
1115
1116 dsb(ish);
1117}
1118
1119/*
AlexeiFedorov5ceff352023-04-12 16:17:00 +01001120 * Populates @s2tt with unassigned_ns s2ttes.
1121 *
1122 * The granule is populated before it is made a table,
1123 * hence, don't use s2tte_write for access.
1124 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001125void s2tt_init_unassigned_ns(const struct s2tt_context *s2_ctx,
1126 unsigned long *s2tt)
AlexeiFedorov5ceff352023-04-12 16:17:00 +01001127{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001128 unsigned long s2tte = s2tte_create_unassigned_ns(s2_ctx);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001129
AlexeiFedorovd2e93932025-01-13 17:24:37 +00001130 assert(s2tt != NULL);
1131
AlexeiFedorov5ceff352023-04-12 16:17:00 +01001132 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001133 s2tt[i] = s2tte;
AlexeiFedorov5ceff352023-04-12 16:17:00 +01001134 }
1135
1136 dsb(ish);
1137}
1138
1139/*
Soby Mathewb4c6df42022-11-09 11:13:29 +00001140 * Populates @s2tt with s2ttes which have HIPAS=DESTROYED.
1141 *
1142 * The granule is populated before it is made a table,
1143 * hence, don't use s2tte_write for access.
1144 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001145void s2tt_init_unassigned_destroyed(const struct s2tt_context *s2_ctx,
1146 unsigned long *s2tt)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001147{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001148 unsigned long s2tte =
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001149 s2tte_create_unassigned_destroyed(s2_ctx);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001150
AlexeiFedorovd2e93932025-01-13 17:24:37 +00001151 assert(s2tt != NULL);
1152
Soby Mathewb4c6df42022-11-09 11:13:29 +00001153 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001154 s2tt[i] = s2tte;
Soby Mathewb4c6df42022-11-09 11:13:29 +00001155 }
AlexeiFedorovd2e93932025-01-13 17:24:37 +00001156
AlexeiFedorovc53b1f72023-07-04 15:37:03 +01001157 dsb(ish);
1158}
Soby Mathewb4c6df42022-11-09 11:13:29 +00001159
AlexeiFedorovc53b1f72023-07-04 15:37:03 +01001160/*
1161 * Populates @s2tt with HIPAS=ASSIGNED, RIPAS=DESTROYED s2ttes that refer to a
1162 * contiguous memory block starting at @pa, and mapped at level @level.
1163 *
1164 * The granule is populated before it is made a table,
1165 * hence, don't use s2tte_write for access.
1166 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001167void s2tt_init_assigned_destroyed(const struct s2tt_context *s2_ctx,
1168 unsigned long *s2tt, unsigned long pa,
1169 long level)
AlexeiFedorovc53b1f72023-07-04 15:37:03 +01001170{
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001171 assert(s2tt != NULL);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001172 assert(level >= S2TT_MIN_BLOCK_LEVEL);
1173 assert(level <= S2TT_PAGE_LEVEL);
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001174 assert(s2tte_is_addr_lvl_aligned(s2_ctx, pa, level));
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001175
AlexeiFedorovc53b1f72023-07-04 15:37:03 +01001176 const unsigned long map_size = s2tte_map_size(level);
1177
1178 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001179 s2tt[i] = s2tte_create_assigned_destroyed(s2_ctx, pa, level);
AlexeiFedorovc53b1f72023-07-04 15:37:03 +01001180 pa += map_size;
1181 }
Soby Mathewb4c6df42022-11-09 11:13:29 +00001182 dsb(ish);
1183}
1184
Soby Mathewb4c6df42022-11-09 11:13:29 +00001185/*
1186 * Populates @s2tt with HIPAS=ASSIGNED, RIPAS=EMPTY s2ttes that refer to a
1187 * contiguous memory block starting at @pa, and mapped at level @level.
1188 *
1189 * The granule is populated before it is made a table,
1190 * hence, don't use s2tte_write for access.
1191 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001192void s2tt_init_assigned_empty(const struct s2tt_context *s2_ctx,
1193 unsigned long *s2tt, unsigned long pa,
1194 long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001195{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001196 assert(level >= S2TT_MIN_BLOCK_LEVEL);
1197 assert(level <= S2TT_PAGE_LEVEL);
1198 assert(s2tt != NULL);
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001199 assert(s2tte_is_addr_lvl_aligned(s2_ctx, pa, level));
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001200
Soby Mathewb4c6df42022-11-09 11:13:29 +00001201 const unsigned long map_size = s2tte_map_size(level);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001202
AlexeiFedorov3a739332023-04-13 13:54:04 +01001203 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001204 s2tt[i] = s2tte_create_assigned_empty(s2_ctx, pa, level);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001205 pa += map_size;
1206 }
1207 dsb(ish);
1208}
1209
1210/*
AlexeiFedorov3a739332023-04-13 13:54:04 +01001211 * Populates @s2tt with assigned_ram s2ttes that refer to a
Soby Mathewb4c6df42022-11-09 11:13:29 +00001212 * contiguous memory block starting at @pa, and mapped at level @level.
1213 *
1214 * The granule is populated before it is made a table,
1215 * hence, don't use s2tte_write for access.
1216 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001217void s2tt_init_assigned_ram(const struct s2tt_context *s2_ctx,
1218 unsigned long *s2tt, unsigned long pa,
1219 long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001220{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001221 assert(level >= S2TT_MIN_BLOCK_LEVEL);
1222 assert(level <= S2TT_PAGE_LEVEL);
1223 assert(s2tt != NULL);
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001224 assert(s2tte_is_addr_lvl_aligned(s2_ctx, pa, level));
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001225
Soby Mathewb4c6df42022-11-09 11:13:29 +00001226 const unsigned long map_size = s2tte_map_size(level);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001227
AlexeiFedorov3a739332023-04-13 13:54:04 +01001228 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001229 s2tt[i] = s2tte_create_assigned_ram(s2_ctx, pa, level);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001230 pa += map_size;
1231 }
1232 dsb(ish);
1233}
1234
1235/*
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +01001236 * Populates @s2tt with NS attributes @attrs that refer to a
Soby Mathewb4c6df42022-11-09 11:13:29 +00001237 * contiguous memory block starting at @pa, and mapped at level @level.
1238 *
1239 * The granule is populated before it is made a table,
1240 * hence, don't use s2tte_write for access.
1241 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001242void s2tt_init_assigned_ns(const struct s2tt_context *s2_ctx,
1243 unsigned long *s2tt, unsigned long attrs,
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +01001244 unsigned long pa, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001245{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001246 assert(level >= S2TT_MIN_BLOCK_LEVEL);
1247 assert(level <= S2TT_PAGE_LEVEL);
1248 assert(s2tt != NULL);
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001249 assert(s2tte_is_addr_lvl_aligned(s2_ctx, pa, level));
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001250
Soby Mathewb4c6df42022-11-09 11:13:29 +00001251 const unsigned long map_size = s2tte_map_size(level);
Soby Mathew217748d2024-10-02 11:02:19 +01001252
1253 attrs &= S2TTE_NS_ATTR_MASK;
Soby Mathewb4c6df42022-11-09 11:13:29 +00001254
AlexeiFedorov3a739332023-04-13 13:54:04 +01001255 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001256 s2tt[i] = s2tte_create_assigned_ns(s2_ctx,
Soby Mathew217748d2024-10-02 11:02:19 +01001257 attrs | pa_to_s2tte(pa, s2_ctx->enable_lpa2),
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001258 level);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001259 pa += map_size;
1260 }
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +01001261
Soby Mathewb4c6df42022-11-09 11:13:29 +00001262 dsb(ish);
1263}
1264
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001265/*
AlexeiFedorovd2e93932025-01-13 17:24:37 +00001266 * Populates @s2tt with HIPAS=ASSIGNED_DEV, RIPAS=EMPTY s2ttes that refer to a
1267 * contiguous memory block starting at @pa, and mapped at level @level.
1268 *
1269 * The granule is populated before it is made a table,
1270 * hence, don't use s2tte_write for access.
1271 */
1272void s2tt_init_assigned_dev_empty(const struct s2tt_context *s2_ctx,
1273 unsigned long *s2tt, unsigned long pa, long level)
1274{
1275 const unsigned long map_size = s2tte_map_size(level);
1276
1277 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
1278 s2tt[i] = s2tte_create_assigned_dev_empty(s2_ctx, pa, level);
1279 pa += map_size;
1280 }
1281
1282 dsb(ish);
1283}
1284
1285/*
1286 * Populates @s2tt with HIPAS=ASSIGNED_DEV, RIPAS=DESTROYED s2ttes that refer to a
1287 * contiguous memory block starting at @pa, and mapped at level @level.
1288 *
1289 * The granule is populated before it is made a table,
1290 * hence, don't use s2tte_write for access.
1291 */
1292void s2tt_init_assigned_dev_destroyed(const struct s2tt_context *s2_ctx,
1293 unsigned long *s2tt, unsigned long pa, long level)
1294{
1295 const unsigned long map_size = s2tte_map_size(level);
1296
1297 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
1298 s2tt[i] = s2tte_create_assigned_dev_destroyed(s2_ctx, pa, level);
1299 pa += map_size;
1300 }
1301
1302 dsb(ish);
1303}
1304
1305/*
1306 * Populates @s2tt with assigned_dev_dev s2ttes that refer to a
1307 * contiguous memory block starting at @pa, and mapped at level @level.
1308 *
1309 * The granule is populated before it is made a table,
1310 * hence, don't use s2tte_write for access.
1311 */
1312void s2tt_init_assigned_dev_dev(const struct s2tt_context *s2_ctx,
1313 unsigned long *s2tt, unsigned long s2tte,
1314 unsigned long pa, long level)
1315{
1316 const unsigned long map_size = s2tte_map_size(level);
1317 unsigned long s2tte_mask = (S2TTE_DEV_ATTRS_MASK | S2TTE_MEMATTR_MASK);
1318
1319 assert(s2_ctx != NULL);
1320 assert(level >= S2TT_MIN_DEV_BLOCK_LEVEL);
1321
1322 /* Add Shareability bits if FEAT_LPA2 is not enabled */
1323 if (!s2_ctx->enable_lpa2) {
1324 s2tte_mask |= S2TTE_SH_MASK;
1325 }
1326
1327 s2tte &= s2tte_mask;
1328
1329 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
1330 s2tt[i] = s2tte_create_assigned_dev_dev(s2_ctx, s2tte | pa, level);
1331 pa += map_size;
1332 }
1333
1334 dsb(ish);
1335}
1336
1337/*
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001338 * Returns true if s2tte is a live RTTE entry. i.e.,
AlexeiFedorov3ebd4622023-07-18 16:27:39 +01001339 * HIPAS is ASSIGNED.
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001340 *
1341 * NOTE: For now, only the RTTE with PA are live.
1342 * This could change with EXPORT/IMPORT support.
1343 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001344static bool s2tte_is_live(const struct s2tt_context *s2_ctx,
1345 unsigned long s2tte, long level)
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001346{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001347 return s2tte_has_pa(s2_ctx, s2tte, level);
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001348}
1349
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001350/* Returns physical address of a S2TTE */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001351unsigned long s2tte_pa(const struct s2tt_context *s2_ctx, unsigned long s2tte,
1352 long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001353{
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001354 bool lpa2;
1355 unsigned long pa;
1356 __unused long min_starting_level;
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001357
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001358 assert(s2_ctx != NULL);
1359
Shruti Gupta0a0d4ee2024-04-22 21:37:25 +01001360 /* cppcheck-suppress misra-c2012-10.6 */
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001361 min_starting_level = (s2_ctx->enable_lpa2 == true) ?
1362 S2TT_MIN_STARTING_LEVEL_LPA2 : S2TT_MIN_STARTING_LEVEL;
1363 assert(level >= min_starting_level);
1364 assert(level <= S2TT_PAGE_LEVEL);
1365 assert(s2tte_has_pa(s2_ctx, s2tte, level));
1366
1367 lpa2 = s2_ctx->enable_lpa2;
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001368
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001369 if (s2tte_is_table(s2_ctx, s2tte, level)) {
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001370 pa = table_entry_to_phys(s2tte, lpa2);
1371 } else {
1372 pa = s2tte_to_pa(s2tte, level, lpa2);
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001373 }
1374
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001375 return pa;
Soby Mathewb4c6df42022-11-09 11:13:29 +00001376}
1377
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001378bool s2tte_is_addr_lvl_aligned(const struct s2tt_context *s2_ctx,
1379 unsigned long addr, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001380{
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001381 assert(s2_ctx != NULL);
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001382
Shruti Gupta0a0d4ee2024-04-22 21:37:25 +01001383 /* cppcheck-suppress misra-c2012-10.6 */
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001384 __unused long min_starting_level = (s2_ctx->enable_lpa2 == true) ?
1385 S2TT_MIN_STARTING_LEVEL_LPA2 : S2TT_MIN_STARTING_LEVEL;
1386 unsigned long levels = (unsigned long)(S2TT_PAGE_LEVEL - level);
1387 unsigned long lsb = (levels * S2TTE_STRIDE) + GRANULE_SHIFT;
1388 unsigned long s2tte_oa_bits = (s2_ctx->enable_lpa2 == true) ?
1389 S2TTE_OA_BITS_LPA2 : S2TTE_OA_BITS;
1390
1391 assert(level <= S2TT_PAGE_LEVEL);
1392 assert(level >= min_starting_level);
1393
1394 return (addr == (addr & BIT_MASK_ULL((s2tte_oa_bits - 1U), lsb)));
Soby Mathewb4c6df42022-11-09 11:13:29 +00001395}
1396
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001397typedef bool (*s2tte_type_checker)(const struct s2tt_context *s2_ctx,
1398 unsigned long s2tte);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001399
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001400static bool table_is_uniform_block(const struct s2tt_context *s2_ctx,
1401 unsigned long *table,
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001402 s2tte_type_checker s2tte_is_x)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001403{
AlexeiFedorov377d81f2023-04-14 16:29:12 +01001404 for (unsigned int i = 0U; i < S2TTES_PER_S2TT; i++) {
1405 unsigned long s2tte = s2tte_read(&table[i]);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001406
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001407 if (!s2tte_is_x(s2_ctx, s2tte)) {
Soby Mathewb4c6df42022-11-09 11:13:29 +00001408 return false;
1409 }
Soby Mathewb4c6df42022-11-09 11:13:29 +00001410 }
1411
1412 return true;
1413}
1414
1415/*
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001416 * Returns true if all s2ttes in @table are unassigned_empty.
Soby Mathewb4c6df42022-11-09 11:13:29 +00001417 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001418bool s2tt_is_unassigned_empty_block(const struct s2tt_context *s2_ctx,
1419 unsigned long *table)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001420{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001421 assert(table != NULL);
1422
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001423 return table_is_uniform_block(s2_ctx, table, s2tte_is_unassigned_empty);
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001424}
1425
1426/*
1427 * Returns true if all s2ttes in @table are unassigned_ram.
1428 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001429bool s2tt_is_unassigned_ram_block(const struct s2tt_context *s2_ctx,
1430 unsigned long *table)
AlexeiFedorovc07a6382023-04-14 11:59:18 +01001431{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001432 assert(table != NULL);
1433
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001434 return table_is_uniform_block(s2_ctx, table, s2tte_is_unassigned_ram);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001435}
1436
1437/*
AlexeiFedorov5ceff352023-04-12 16:17:00 +01001438 * Returns true if all s2ttes in @table are unassigned_ns
1439 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001440bool s2tt_is_unassigned_ns_block(const struct s2tt_context *s2_ctx,
1441 unsigned long *table)
AlexeiFedorov5ceff352023-04-12 16:17:00 +01001442{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001443 assert(table != NULL);
1444
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001445 return table_is_uniform_block(s2_ctx, table, s2tte_is_unassigned_ns);
AlexeiFedorov5ceff352023-04-12 16:17:00 +01001446}
1447
1448/*
AlexeiFedorovc53b1f72023-07-04 15:37:03 +01001449 * Returns true if all s2ttes in @table are unassigned_destroyed
Soby Mathewb4c6df42022-11-09 11:13:29 +00001450 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001451bool s2tt_is_unassigned_destroyed_block(const struct s2tt_context *s2_ctx,
1452 unsigned long *table)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001453{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001454 assert(table != NULL);
1455
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001456 return table_is_uniform_block(s2_ctx, table,
1457 s2tte_is_unassigned_destroyed);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001458}
1459
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001460typedef bool (*s2tte_type_level_checker)(const struct s2tt_context *s2_ctx,
1461 unsigned long s2tte, long level);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001462
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001463static bool table_maps_block(const struct s2tt_context *s2_ctx,
1464 unsigned long *table,
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001465 long level,
1466 s2tte_type_level_checker s2tte_is_x,
1467 bool check_ns_attrs)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001468{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001469 assert(table != NULL);
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001470 assert(s2_ctx != NULL);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001471
Soby Mathew217748d2024-10-02 11:02:19 +01001472 unsigned long base_pa;
Soby Mathewb4c6df42022-11-09 11:13:29 +00001473 unsigned long map_size = s2tte_map_size(level);
1474 unsigned long s2tte = s2tte_read(&table[0]);
Javier Almansa Sobrino8865ec32024-04-18 10:50:03 +01001475 unsigned long s2tt_ns_attrs;
Soby Mathewb4c6df42022-11-09 11:13:29 +00001476 unsigned int i;
1477
Javier Almansa Sobrino6e3b5522024-04-10 12:12:13 +01001478 if (s2_ctx->enable_lpa2 == true) {
1479 assert(level >= S2TT_MIN_STARTING_LEVEL_LPA2);
1480 } else {
1481 assert(level >= S2TT_MIN_STARTING_LEVEL);
1482 }
1483
1484 assert(level <= S2TT_PAGE_LEVEL);
1485
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001486 if (!s2tte_is_x(s2_ctx, s2tte, level)) {
Soby Mathewb4c6df42022-11-09 11:13:29 +00001487 return false;
1488 }
1489
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001490 base_pa = s2tte_pa(s2_ctx, s2tte, level);
1491 if (!s2tte_is_addr_lvl_aligned(s2_ctx, base_pa, level - 1L)) {
Soby Mathewb4c6df42022-11-09 11:13:29 +00001492 return false;
1493 }
1494
Soby Mathew217748d2024-10-02 11:02:19 +01001495 s2tt_ns_attrs = s2tte & S2TTE_NS_ATTR_MASK;
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001496
Soby Mathewb4c6df42022-11-09 11:13:29 +00001497 for (i = 1U; i < S2TTES_PER_S2TT; i++) {
1498 unsigned long expected_pa = base_pa + (i * map_size);
1499
1500 s2tte = s2tte_read(&table[i]);
1501
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001502 if (!s2tte_is_x(s2_ctx, s2tte, level)) {
Soby Mathewb4c6df42022-11-09 11:13:29 +00001503 return false;
1504 }
1505
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001506 if (s2tte_pa(s2_ctx, s2tte, level) != expected_pa) {
Soby Mathewb4c6df42022-11-09 11:13:29 +00001507 return false;
1508 }
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +01001509
1510 if (check_ns_attrs) {
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001511 unsigned long ns_attrs =
Soby Mathew217748d2024-10-02 11:02:19 +01001512 s2tte & S2TTE_NS_ATTR_MASK;
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +01001513
1514 /*
1515 * We match all the attributes in the S2TTE
1516 * except for the AF bit.
1517 */
Javier Almansa Sobrino8865ec32024-04-18 10:50:03 +01001518 if (s2tt_ns_attrs != ns_attrs) {
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +01001519 return false;
1520 }
1521 }
Soby Mathewb4c6df42022-11-09 11:13:29 +00001522 }
1523
1524 return true;
1525}
1526
1527/*
AlexeiFedorov3a739332023-04-13 13:54:04 +01001528 * Returns true if all s2ttes are assigned_empty
Soby Mathewb4c6df42022-11-09 11:13:29 +00001529 * and refer to a contiguous block of granules aligned to @level - 1.
1530 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001531bool s2tt_maps_assigned_empty_block(const struct s2tt_context *s2_ctx,
1532 unsigned long *table, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001533{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001534 return table_maps_block(s2_ctx, table, level,
1535 s2tte_is_assigned_empty, false);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001536}
1537
1538/*
AlexeiFedorov3a739332023-04-13 13:54:04 +01001539 * Returns true if all s2ttes are assigned_ram and
Soby Mathewb4c6df42022-11-09 11:13:29 +00001540 * refer to a contiguous block of granules aligned to @level - 1.
1541 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001542bool s2tt_maps_assigned_ram_block(const struct s2tt_context *s2_ctx,
1543 unsigned long *table, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001544{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001545 return table_maps_block(s2_ctx, table, level,
1546 s2tte_is_assigned_ram, false);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001547}
1548
1549/*
Javier Almansa Sobrino15fc44e2023-09-29 13:52:04 +01001550 * Returns true if
1551 * - all s2ttes in @table are assigned_ns s2ttes and
1552 * - they refer to a contiguous block of granules aligned to @level - 1 and
1553 * - all the s2tte attributes in @table controlled by the host are identical
AlexeiFedorov3a739332023-04-13 13:54:04 +01001554 *
1555 * @pre: @table maps IPA outside PAR.
Soby Mathewb4c6df42022-11-09 11:13:29 +00001556 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001557bool s2tt_maps_assigned_ns_block(const struct s2tt_context *s2_ctx,
1558 unsigned long *table, long level)
Soby Mathewb4c6df42022-11-09 11:13:29 +00001559{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001560 return table_maps_block(s2_ctx, table, level,
1561 s2tte_is_assigned_ns, true);
Soby Mathewb4c6df42022-11-09 11:13:29 +00001562}
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001563
1564/*
AlexeiFedorov3f840a02023-07-19 10:55:05 +01001565 * Returns true if all s2ttes are assigned_destroyed and
1566 * refer to a contiguous block of granules aligned to @level - 1.
1567 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001568bool s2tt_maps_assigned_destroyed_block(const struct s2tt_context *s2_ctx,
1569 unsigned long *table, long level)
AlexeiFedorov3f840a02023-07-19 10:55:05 +01001570{
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001571 return table_maps_block(s2_ctx, table, level,
1572 s2tte_is_assigned_destroyed, false);
AlexeiFedorov3f840a02023-07-19 10:55:05 +01001573}
1574
1575/*
AlexeiFedorovd2e93932025-01-13 17:24:37 +00001576 * Returns true if all s2ttes are assigned_dev_empty and
1577 * refer to a contiguous block of granules aligned to @level - 1.
1578 */
1579bool s2tt_maps_assigned_dev_empty_block(const struct s2tt_context *s2_ctx,
1580 unsigned long *table, long level)
1581{
1582 return table_maps_block(s2_ctx, table, level,
1583 s2tte_is_assigned_dev_empty, false);
1584}
1585
1586/*
1587 * Returns true if all s2ttes are assigned_dev_destroyed and
1588 * refer to a contiguous block of granules aligned to @level - 1.
1589 */
1590bool s2tt_maps_assigned_dev_destroyed_block(const struct s2tt_context *s2_ctx,
1591 unsigned long *table, long level)
1592{
1593 return table_maps_block(s2_ctx, table, level,
1594 s2tte_is_assigned_dev_destroyed, false);
1595}
1596
1597/*
1598 * Returns true if all s2ttes are assigned_dev_dev and
1599 * refer to a contiguous block of granules aligned to @level - 1.
1600 */
1601bool s2tt_maps_assigned_dev_dev_block(const struct s2tt_context *s2_ctx,
1602 unsigned long *table, long level)
1603{
1604 return table_maps_block(s2_ctx, table, level,
1605 s2tte_is_assigned_dev_dev, false);
1606}
1607
1608/*
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001609 * Scan the RTT @s2tt (which is @wi.level), from the entry (@wi.index) and
AlexeiFedorov3ebd4622023-07-18 16:27:39 +01001610 * skip the non-live entries (i.e., HIPAS=UNASSIGNED).
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001611 * In other words, the scanning stops when a live RTTE is encountered or we
1612 * reach the end of this RTT.
1613 *
1614 * For now an RTTE can be considered non-live if it doesn't have a PA.
1615 * NOTE: This would change with EXPORT/IMPORT where we may have metadata stored
1616 * in the RTTE.
1617 *
1618 * @addr is not necessarily aligned to the wi.last_level (e.g., if we were called
1619 * with RMI_ERROR_RTT).
1620 *
1621 * Returns:
1622 * - If the entry @wi.index is live, returns @addr.
1623 * - If none of the entries in the @s2tt are "live", returns the address of the
1624 * first entry in the next table.
1625 * - Otherwise, the address of the first live entry in @s2tt
1626 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001627unsigned long s2tt_skip_non_live_entries(const struct s2tt_context *s2_ctx,
1628 unsigned long addr,
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001629 unsigned long *table,
1630 const struct s2tt_walk *wi)
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001631{
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001632 assert(table != NULL);
1633 assert(wi != NULL);
1634 assert(wi->index <= S2TTES_PER_S2TT);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001635 assert(wi->last_level <= S2TT_PAGE_LEVEL);
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001636 assert(s2_ctx != NULL);
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001637
AlexeiFedorov56e1a8e2023-09-01 17:06:13 +01001638 unsigned long i, index = wi->index;
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001639 long level = wi->last_level;
1640 unsigned long map_size;
Shruti Gupta0a0d4ee2024-04-22 21:37:25 +01001641
1642 /* cppcheck-suppress misra-c2012-10.6 */
Javier Almansa Sobrinof6fff692024-02-02 17:13:57 +00001643 __unused long min_starting_level = (s2_ctx->enable_lpa2 == true) ?
1644 S2TT_MIN_STARTING_LEVEL_LPA2 : S2TT_MIN_STARTING_LEVEL;
1645
1646 assert(wi->last_level >= min_starting_level);
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001647
1648 /*
1649 * If the entry for the map_addr is live,
1650 * return @addr.
1651 */
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001652 if (s2tte_is_live(s2_ctx, s2tte_read(&table[index]), level)) {
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001653 return addr;
1654 }
1655
1656 /*
1657 * Align the address DOWN to the map_size, as expected for the @level,
1658 * so that we can compute the correct address by using the index.
1659 */
1660 map_size = s2tte_map_size(level);
1661 addr &= ~(map_size - 1UL);
1662
1663 /* Skip the "index" */
AlexeiFedorov56e1a8e2023-09-01 17:06:13 +01001664 for (i = index + 1UL; i < S2TTES_PER_S2TT; i++) {
Javier Almansa Sobrino1e1781e2023-10-18 18:25:56 +01001665 unsigned long s2tte = s2tte_read(&table[i]);
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001666
Javier Almansa Sobrino2595cd82024-01-25 18:25:12 +00001667 if (s2tte_is_live(s2_ctx, s2tte, level)) {
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001668 break;
1669 }
1670 }
1671
AlexeiFedorov56e1a8e2023-09-01 17:06:13 +01001672 return (addr + ((i - index) * map_size));
AlexeiFedorov917eabf2023-04-24 12:20:41 +01001673}