arch/riscv/kernel/cacheinfo.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2017 SiFive
   4  */
   5
   6 #include <linux/cacheinfo.h>
   7 #include <linux/cpu.h>
   8 #include <linux/of.h>
   9 #include <linux/of_device.h>
  10
  11 static void ci_leaf_init(struct cacheinfo *this_leaf,
  12                          struct device_node *node,
  13                          enum cache_type type, unsigned int level)
  14 {
  15         this_leaf->level = level;
  16         this_leaf->type = type;
  17 }
  18
  19 static int __init_cache_level(unsigned int cpu)
  20 {
  21         struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
  22         struct device_node *np = of_cpu_device_node_get(cpu);
  23         struct device_node *prev = NULL;
  24         int levels = 0, leaves = 0, level;
  25
  26         if (of_property_read_bool(np, "cache-size"))
  27                 ++leaves;
  28         if (of_property_read_bool(np, "i-cache-size"))
  29                 ++leaves;
  30         if (of_property_read_bool(np, "d-cache-size"))
  31                 ++leaves;
  32         if (leaves > 0)
  33                 levels = 1;
  34
  35         prev = np;
  36         while ((np = of_find_next_cache_node(np))) {
  37                 of_node_put(prev);
  38                 prev = np;
  39                 if (!of_device_is_compatible(np, "cache"))
  40                         break;
  41                 if (of_property_read_u32(np, "cache-level", &level))
  42                         break;
  43                 if (level <= levels)
  44                         break;
  45                 if (of_property_read_bool(np, "cache-size"))
  46                         ++leaves;
  47                 if (of_property_read_bool(np, "i-cache-size"))
  48                         ++leaves;
  49                 if (of_property_read_bool(np, "d-cache-size"))
  50                         ++leaves;
  51                 levels = level;
  52         }
  53
  54         of_node_put(np);
  55         this_cpu_ci->num_levels = levels;
  56         this_cpu_ci->num_leaves = leaves;
  57
  58         return 0;
  59 }
  60
  61 static int __populate_cache_leaves(unsigned int cpu)
  62 {
  63         struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
  64         struct cacheinfo *this_leaf = this_cpu_ci->info_list;
  65         struct device_node *np = of_cpu_device_node_get(cpu);
  66         struct device_node *prev = NULL;
  67         int levels = 1, level = 1;
  68
  69         if (of_property_read_bool(np, "cache-size"))
  70                 ci_leaf_init(this_leaf++, np, CACHE_TYPE_UNIFIED, level);
  71         if (of_property_read_bool(np, "i-cache-size"))
  72                 ci_leaf_init(this_leaf++, np, CACHE_TYPE_INST, level);
  73         if (of_property_read_bool(np, "d-cache-size"))
  74                 ci_leaf_init(this_leaf++, np, CACHE_TYPE_DATA, level);
  75
  76         prev = np;
  77         while ((np = of_find_next_cache_node(np))) {
  78                 of_node_put(prev);
  79                 prev = np;
  80                 if (!of_device_is_compatible(np, "cache"))
  81                         break;
  82                 if (of_property_read_u32(np, "cache-level", &level))
  83                         break;
  84                 if (level <= levels)
  85                         break;
  86                 if (of_property_read_bool(np, "cache-size"))
  87                         ci_leaf_init(this_leaf++, np, CACHE_TYPE_UNIFIED, level);
  88                 if (of_property_read_bool(np, "i-cache-size"))
  89                         ci_leaf_init(this_leaf++, np, CACHE_TYPE_INST, level);
  90                 if (of_property_read_bool(np, "d-cache-size"))
  91                         ci_leaf_init(this_leaf++, np, CACHE_TYPE_DATA, level);
  92                 levels = level;
  93         }
  94         of_node_put(np);
  95
  96         return 0;
  97 }
  98
  99 DEFINE_SMP_CALL_CACHE_FUNCTION(init_cache_level)
 100 DEFINE_SMP_CALL_CACHE_FUNCTION(populate_cache_leaves)