1// SPDX-License-Identifier: GPL-2.0-only
 2/*
 3 * MIPS cacheinfo support
 4 */
 5#include <linux/cacheinfo.h>
 6
 7/* Populates leaf and increments to next leaf */
 8#define populate_cache(cache, leaf, c_level, c_type)		\
 9do {								\
10	leaf->type = c_type;					\
11	leaf->level = c_level;					\
12	leaf->coherency_line_size = c->cache.linesz;		\
13	leaf->number_of_sets = c->cache.sets;			\
14	leaf->ways_of_associativity = c->cache.ways;		\
15	leaf->size = c->cache.linesz * c->cache.sets *		\
16		c->cache.ways;					\
17	leaf++;							\
18} while (0)
19
20static int __init_cache_level(unsigned int cpu)
21{
22	struct cpuinfo_mips *c = &current_cpu_data;
23	struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
24	int levels = 0, leaves = 0;
25
26	/*
27	 * If Dcache is not set, we assume the cache structures
28	 * are not properly initialized.
29	 */
30	if (c->dcache.waysize)
31		levels += 1;
32	else
33		return -ENOENT;
34
35
36	leaves += (c->icache.waysize) ? 2 : 1;
37
38	if (c->scache.waysize) {
39		levels++;
40		leaves++;
41	}
42
43	if (c->tcache.waysize) {
44		levels++;
45		leaves++;
46	}
47
48	this_cpu_ci->num_levels = levels;
49	this_cpu_ci->num_leaves = leaves;
50	return 0;
51}
52
53static int __populate_cache_leaves(unsigned int cpu)
54{
55	struct cpuinfo_mips *c = &current_cpu_data;
56	struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
57	struct cacheinfo *this_leaf = this_cpu_ci->info_list;
58
59	if (c->icache.waysize) {
60		populate_cache(dcache, this_leaf, 1, CACHE_TYPE_DATA);
61		populate_cache(icache, this_leaf, 1, CACHE_TYPE_INST);
62	} else {
63		populate_cache(dcache, this_leaf, 1, CACHE_TYPE_UNIFIED);
64	}
65
66	if (c->scache.waysize)
67		populate_cache(scache, this_leaf, 2, CACHE_TYPE_UNIFIED);
68
69	if (c->tcache.waysize)
70		populate_cache(tcache, this_leaf, 3, CACHE_TYPE_UNIFIED);
71
72	this_cpu_ci->cpu_map_populated = true;
73
74	return 0;
75}
76
77DEFINE_SMP_CALL_CACHE_FUNCTION(init_cache_level)
78DEFINE_SMP_CALL_CACHE_FUNCTION(populate_cache_leaves)