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 19 static 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->level = level; 24 this_leaf->type = type; 25 } 26 27 static int __init_cache_level(unsigned int cpu) 28 { 29 struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu); 30 struct device_node *np = of_cpu_device_node_get(cpu); 31 struct device_node *prev = NULL; 32 int levels = 0, leaves = 0, level; 33 34 if (of_property_read_bool(np, "cache-size")) 35 ++leaves; 36 if (of_property_read_bool(np, "i-cache-size")) 37 ++leaves; 38 if (of_property_read_bool(np, "d-cache-size")) 39 ++leaves; 40 if (leaves > 0) 41 levels = 1; 42 43 prev = np; 44 while ((np = of_find_next_cache_node(np))) { 45 of_node_put(prev); 46 prev = np; 47 if (!of_device_is_compatible(np, "cache")) 48 break; 49 if (of_property_read_u32(np, "cache-level", &level)) 50 break; 51 if (level <= levels) 52 break; 53 if (of_property_read_bool(np, "cache-size")) 54 ++leaves; 55 if (of_property_read_bool(np, "i-cache-size")) 56 ++leaves; 57 if (of_property_read_bool(np, "d-cache-size")) 58 ++leaves; 59 levels = level; 60 } 61 62 of_node_put(np); 63 this_cpu_ci->num_levels = levels; 64 this_cpu_ci->num_leaves = leaves; 65 66 return 0; 67 } 68 69 static int __populate_cache_leaves(unsigned int cpu) 70 { 71 struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu); 72 struct cacheinfo *this_leaf = this_cpu_ci->info_list; 73 struct device_node *np = of_cpu_device_node_get(cpu); 74 struct device_node *prev = NULL; 75 int levels = 1, level = 1; 76 77 if (of_property_read_bool(np, "cache-size")) 78 ci_leaf_init(this_leaf++, np, CACHE_TYPE_UNIFIED, level); 79 if (of_property_read_bool(np, "i-cache-size")) 80 ci_leaf_init(this_leaf++, np, CACHE_TYPE_INST, level); 81 if (of_property_read_bool(np, "d-cache-size")) 82 ci_leaf_init(this_leaf++, np, CACHE_TYPE_DATA, level); 83 84 prev = np; 85 while ((np = of_find_next_cache_node(np))) { 86 of_node_put(prev); 87 prev = np; 88 if (!of_device_is_compatible(np, "cache")) 89 break; 90 if (of_property_read_u32(np, "cache-level", &level)) 91 break; 92 if (level <= levels) 93 break; 94 if (of_property_read_bool(np, "cache-size")) 95 ci_leaf_init(this_leaf++, np, CACHE_TYPE_UNIFIED, level); 96 if (of_property_read_bool(np, "i-cache-size")) 97 ci_leaf_init(this_leaf++, np, CACHE_TYPE_INST, level); 98 if (of_property_read_bool(np, "d-cache-size")) 99 ci_leaf_init(this_leaf++, np, CACHE_TYPE_DATA, level); 100 levels = level; 101 } 102 of_node_put(np); 103 104 return 0; 105 } 106 107 DEFINE_SMP_CALL_CACHE_FUNCTION(init_cache_level) 108 DEFINE_SMP_CALL_CACHE_FUNCTION(populate_cache_leaves) 109