1/*
  2 * Copyright (C) 2017 SiFive
  3 *
  4 *   This program is free software; you can redistribute it and/or
  5 *   modify it under the terms of the GNU General Public License
  6 *   as published by the Free Software Foundation, version 2.
  7 *
  8 *   This program is distributed in the hope that it will be useful,
  9 *   but WITHOUT ANY WARRANTY; without even the implied warranty of
 10 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 11 *   GNU General Public License for more details.
 12 */
 13
 14#include <linux/cacheinfo.h>
 15#include <linux/cpu.h>
 16#include <linux/of.h>
 17#include <linux/of_device.h>
 18
 19static void ci_leaf_init(struct cacheinfo *this_leaf,
 20			 struct device_node *node,
 21			 enum cache_type type, unsigned int level)
 22{
 23	this_leaf->of_node = node;
 24	this_leaf->level = level;
 25	this_leaf->type = type;
 26	/* not a sector cache */
 27	this_leaf->physical_line_partition = 1;
 28	/* TODO: Add to DTS */
 29	this_leaf->attributes =
 30		CACHE_WRITE_BACK
 31		| CACHE_READ_ALLOCATE
 32		| CACHE_WRITE_ALLOCATE;
 33}
 34
 35static int __init_cache_level(unsigned int cpu)
 36{
 37	struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
 38	struct device_node *np = of_cpu_device_node_get(cpu);
 39	int levels = 0, leaves = 0, level;
 40
 41	if (of_property_read_bool(np, "cache-size"))
 42		++leaves;
 43	if (of_property_read_bool(np, "i-cache-size"))
 44		++leaves;
 45	if (of_property_read_bool(np, "d-cache-size"))
 46		++leaves;
 47	if (leaves > 0)
 48		levels = 1;
 49
 50	while ((np = of_find_next_cache_node(np))) {
 51		if (!of_device_is_compatible(np, "cache"))
 52			break;
 53		if (of_property_read_u32(np, "cache-level", &level))
 54			break;
 55		if (level <= levels)
 56			break;
 57		if (of_property_read_bool(np, "cache-size"))
 58			++leaves;
 59		if (of_property_read_bool(np, "i-cache-size"))
 60			++leaves;
 61		if (of_property_read_bool(np, "d-cache-size"))
 62			++leaves;
 63		levels = level;
 64	}
 65
 66	this_cpu_ci->num_levels = levels;
 67	this_cpu_ci->num_leaves = leaves;
 68	return 0;
 69}
 70
 71static int __populate_cache_leaves(unsigned int cpu)
 72{
 73	struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
 74	struct cacheinfo *this_leaf = this_cpu_ci->info_list;
 75	struct device_node *np = of_cpu_device_node_get(cpu);
 76	int levels = 1, level = 1;
 77
 78	if (of_property_read_bool(np, "cache-size"))
 79		ci_leaf_init(this_leaf++, np, CACHE_TYPE_UNIFIED, level);
 80	if (of_property_read_bool(np, "i-cache-size"))
 81		ci_leaf_init(this_leaf++, np, CACHE_TYPE_INST, level);
 82	if (of_property_read_bool(np, "d-cache-size"))
 83		ci_leaf_init(this_leaf++, np, CACHE_TYPE_DATA, level);
 84
 85	while ((np = of_find_next_cache_node(np))) {
 86		if (!of_device_is_compatible(np, "cache"))
 87			break;
 88		if (of_property_read_u32(np, "cache-level", &level))
 89			break;
 90		if (level <= levels)
 91			break;
 92		if (of_property_read_bool(np, "cache-size"))
 93			ci_leaf_init(this_leaf++, np, CACHE_TYPE_UNIFIED, level);
 94		if (of_property_read_bool(np, "i-cache-size"))
 95			ci_leaf_init(this_leaf++, np, CACHE_TYPE_INST, level);
 96		if (of_property_read_bool(np, "d-cache-size"))
 97			ci_leaf_init(this_leaf++, np, CACHE_TYPE_DATA, level);
 98		levels = level;
 99	}
100
101	return 0;
102}
103
104DEFINE_SMP_CALL_CACHE_FUNCTION(init_cache_level)
105DEFINE_SMP_CALL_CACHE_FUNCTION(populate_cache_leaves)