arch/riscv/kernel/cacheinfo.c

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