blob: 4bf6e59edb9a0b81c62069763d7836a8268678ad (
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
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
|
/*
* Copyright (c) 2021, Arm Limited. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <stdbool.h>
#include <stdio.h>
#include <stdlib.h>
#include <arch_features.h>
#include <arch_helpers.h>
#include <lib/extensions/sme.h>
#include <test_helpers.h>
#include <tftf_lib.h>
test_result_t test_sme_support(void)
{
/* SME is an AArch64-only feature.*/
SKIP_TEST_IF_AARCH32();
#ifdef __aarch64__
u_register_t reg;
unsigned int current_vector_len;
unsigned int requested_vector_len;
unsigned int len_max;
/* Skip the test if SME is not supported. */
if (!feat_sme_supported()) {
INFO("SME not supported, skipping.\n");
return TEST_RESULT_SKIPPED;
}
/* Enable SME for use at NS EL2. */
if (sme_enable() != 0) {
ERROR("Could not enable SME.\n");
return TEST_RESULT_FAIL;
}
/* Make sure TPIDR2_EL0 is accessible. */
write_tpidr2_el0(0);
if (read_tpidr2_el0() != 0) {
ERROR("Could not read TPIDR2_EL0.\n");
return TEST_RESULT_FAIL;
}
write_tpidr2_el0(0xb0bafe77);
if (read_tpidr2_el0() != 0xb0bafe77) {
ERROR("Could not write TPIDR2_EL0.\n");
return TEST_RESULT_FAIL;
}
/* Make sure we can start and stop streaming mode. */
VERBOSE("Entering Streaming SVE mode.\n");
sme_smstart(false);
read_smcr_el2();
sme_smstop(false);
sme_smstart(true);
read_smcr_el2();
sme_smstop(true);
/*
* Iterate through values for LEN to detect supported vector lengths.
* SME instructions aren't supported by GCC yet so for now this is all
* we'll do.
*/
sme_smstart(false);
/* Write SMCR_EL2 with the LEN max to find implemented width. */
write_smcr_el2(SME_SMCR_LEN_MAX);
len_max = (unsigned int)read_smcr_el2();
VERBOSE("Maximum SMCR_EL2.LEN value: 0x%x\n", len_max);
VERBOSE("Enumerating supported vector lengths...\n");
for (unsigned int i = 0; i <= len_max; i++) {
/* Load new value into SMCR_EL2.LEN */
reg = read_smcr_el2();
reg &= ~(SMCR_ELX_LEN_MASK << SMCR_ELX_LEN_SHIFT);
reg |= (i << SMCR_ELX_LEN_SHIFT);
write_smcr_el2(reg);
/* Compute current and requested vector lengths in bits. */
current_vector_len = ((unsigned int)sme_rdvl_1() * 8U);
requested_vector_len = (i+1U)*128U;
/*
* We count down from the maximum SMLEN value, so if the values
* match, we've found the largest supported value for SMLEN.
*/
if (current_vector_len == requested_vector_len) {
VERBOSE("SUPPORTED: %u bits (LEN=%u)\n", requested_vector_len, i);
} else {
VERBOSE("NOT SUPPORTED: %u bits (LEN=%u)\n", requested_vector_len, i);
}
}
sme_smstop(false);
/* If FEAT_SME_FA64 then attempt to execute an illegal instruction. */
if (feat_sme_fa64_supported()) {
VERBOSE("FA64 supported, trying illegal instruction.\n");
sme_try_illegal_instruction();
}
return TEST_RESULT_SUCCESS;
#endif /* __aarch64__ */
}
|