blob: fd1a0fd0043661dbf22b3a9a038648ad9aaaa4d0 (
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
105
|
/*
* SPDX-License-Identifier: BSD-2-Clause
*
* Copyright (c) 2019 Western Digital Corporation or its affiliates.
*
* Authors:
* Anup Patel <[email protected]>
*/
#include <sbi/riscv_asm.h>
#include <sbi/riscv_encoding.h>
#include <sbi/sbi_error.h>
#include <sbi/sbi_console.h>
#include <sbi/sbi_pmp.h>
static unsigned long ctz(unsigned long x)
{
unsigned long ret = 0;
if (x == 0)
return 8 * sizeof(x);
while (!(x & 1UL)) {
ret++;
x = x >> 1;
}
return ret;
}
bool sbi_pmp_is_enabled(pmp_t *pmp)
{
/* If address matching bits are non-zero, the entry is enable */
if (pmp->cfg & PMP_A)
return true;
return false;
}
int sbi_pmp_encode(pmp_t *pmp, unsigned long prot, unsigned long addr,
unsigned long log2len)
{
/* check parameters */
if (log2len > __riscv_xlen || log2len < PMP_SHIFT)
return SBI_EINVAL;
/* encode PMP config */
prot &= ~PMP_A;
prot |= (log2len == PMP_SHIFT) ? PMP_A_NA4 : PMP_A_NAPOT;
pmp->cfg = prot;
/* encode PMP address */
if (log2len == PMP_SHIFT) {
pmp->addr = (addr >> PMP_SHIFT);
} else {
if (log2len == __riscv_xlen) {
pmp->addr = -1UL;
} else {
unsigned long addrmask;
addrmask = (1UL << (log2len - PMP_SHIFT)) - 1;
pmp->addr = ((addr >> PMP_SHIFT) & ~addrmask);
pmp->addr |= (addrmask >> 1);
}
}
return SBI_OK;
}
int sbi_pmp_decode(pmp_t *pmp, unsigned long *prot_out, unsigned long *addr_out,
unsigned long *log2len)
{
unsigned long prot;
unsigned long t1, addr, len;
/* check parameters */
if (!prot_out || !addr_out || !log2len)
return SBI_EINVAL;
*prot_out = *addr_out = *log2len = 0;
/* decode PMP config */
prot = pmp->cfg;
/* decode PMP address */
if ((prot & PMP_A) == PMP_A_NAPOT) {
addr = pmp->addr;
if (addr == -1UL) {
addr = 0;
len = __riscv_xlen;
} else {
t1 = ctz(~addr);
addr = (addr & ~((1UL << t1) - 1)) << PMP_SHIFT;
len = (t1 + PMP_SHIFT + 1);
}
} else {
addr = pmp->addr << PMP_SHIFT;
len = PMP_SHIFT;
}
/* return details */
*prot_out = prot;
*addr_out = addr;
*log2len = len;
return SBI_OK;
}
|
