1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/acpi.h>
21#include <linux/cacheinfo.h>
22#include <linux/of.h>
23
24#define MAX_CACHE_LEVEL 7
25
26#define CLIDR_CTYPE_SHIFT(level) (3 * (level - 1))
27#define CLIDR_CTYPE_MASK(level) (7 << CLIDR_CTYPE_SHIFT(level))
28#define CLIDR_CTYPE(clidr, level) \
29 (((clidr) & CLIDR_CTYPE_MASK(level)) >> CLIDR_CTYPE_SHIFT(level))
30
31static inline enum cache_type get_cache_type(int level)
32{
33 u64 clidr;
34
35 if (level > MAX_CACHE_LEVEL)
36 return CACHE_TYPE_NOCACHE;
37 clidr = read_sysreg(clidr_el1);
38 return CLIDR_CTYPE(clidr, level);
39}
40
41static void ci_leaf_init(struct cacheinfo *this_leaf,
42 enum cache_type type, unsigned int level)
43{
44 this_leaf->level = level;
45 this_leaf->type = type;
46}
47
48static int __init_cache_level(unsigned int cpu)
49{
50 unsigned int ctype, level, leaves, fw_level;
51 struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
52
53 for (level = 1, leaves = 0; level <= MAX_CACHE_LEVEL; level++) {
54 ctype = get_cache_type(level);
55 if (ctype == CACHE_TYPE_NOCACHE) {
56 level--;
57 break;
58 }
59
60 leaves += (ctype == CACHE_TYPE_SEPARATE) ? 2 : 1;
61 }
62
63 if (acpi_disabled)
64 fw_level = of_find_last_cache_level(cpu);
65 else
66 fw_level = acpi_find_last_cache_level(cpu);
67
68 if (level < fw_level) {
69
70
71
72
73
74 leaves += (fw_level - level);
75 level = fw_level;
76 }
77
78 this_cpu_ci->num_levels = level;
79 this_cpu_ci->num_leaves = leaves;
80 return 0;
81}
82
83static int __populate_cache_leaves(unsigned int cpu)
84{
85 unsigned int level, idx;
86 enum cache_type type;
87 struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
88 struct cacheinfo *this_leaf = this_cpu_ci->info_list;
89
90 for (idx = 0, level = 1; level <= this_cpu_ci->num_levels &&
91 idx < this_cpu_ci->num_leaves; idx++, level++) {
92 type = get_cache_type(level);
93 if (type == CACHE_TYPE_SEPARATE) {
94 ci_leaf_init(this_leaf++, CACHE_TYPE_DATA, level);
95 ci_leaf_init(this_leaf++, CACHE_TYPE_INST, level);
96 } else {
97 ci_leaf_init(this_leaf++, type, level);
98 }
99 }
100 return 0;
101}
102
103DEFINE_SMP_CALL_CACHE_FUNCTION(init_cache_level)
104DEFINE_SMP_CALL_CACHE_FUNCTION(populate_cache_leaves)
105