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->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 35 static 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 71 static 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 104 DEFINE_SMP_CALL_CACHE_FUNCTION(init_cache_level) 105 DEFINE_SMP_CALL_CACHE_FUNCTION(populate_cache_leaves) 106