Quelle  cacheinfo.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * OpenRISC cacheinfo support
 *
 * Based on work done for MIPS and LoongArch. All original copyrights
 * apply as per the original source declaration.
 *
 * OpenRISC implementation:
 * Copyright (C) 2025 Sahil Siddiq <sahilcdq@proton.me>
 */

#include <linux/cacheinfo.h>
#include <asm/cpuinfo.h>
#include <asm/spr.h>
#include <asm/spr_defs.h>

static inline void ci_leaf_init(struct cacheinfo *this_leaf, enum cache_type type,
    unsigned int level, struct cache_desc *cache, int cpu)
{
 this_leaf->type = type;
 this_leaf->level = level;
 this_leaf->coherency_line_size = cache->block_size;
 this_leaf->number_of_sets = cache->sets;
 this_leaf->ways_of_associativity = cache->ways;
 this_leaf->size = cache->size;
 cpumask_set_cpu(cpu, &this_leaf->shared_cpu_map);
}

int init_cache_level(unsigned int cpu)
{
 struct cpuinfo_or1k *cpuinfo = &cpuinfo_or1k[smp_processor_id()];
 struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
 int leaves = 0, levels = 0;
 unsigned long upr = mfspr(SPR_UPR);
 unsigned long iccfgr, dccfgr;

 if (!(upr & SPR_UPR_UP)) {
  printk(KERN_INFO
         "-- no UPR register... unable to detect configuration\n");
  return -ENOENT;
 }

 if (cpu_cache_is_present(SPR_UPR_DCP)) {
  dccfgr = mfspr(SPR_DCCFGR);
  cpuinfo->dcache.ways = 1 << (dccfgr & SPR_DCCFGR_NCW);
  cpuinfo->dcache.sets = 1 << ((dccfgr & SPR_DCCFGR_NCS) >> 3);
  cpuinfo->dcache.block_size = 16 << ((dccfgr & SPR_DCCFGR_CBS) >> 7);
  cpuinfo->dcache.size =
      cpuinfo->dcache.sets * cpuinfo->dcache.ways * cpuinfo->dcache.block_size;
  leaves += 1;
  printk(KERN_INFO
         "-- dcache: %d bytes total, %d bytes/line, %d set(s), %d way(s)\n",
         cpuinfo->dcache.size, cpuinfo->dcache.block_size,
         cpuinfo->dcache.sets, cpuinfo->dcache.ways);
 } else
  printk(KERN_INFO "-- dcache disabled\n");

 if (cpu_cache_is_present(SPR_UPR_ICP)) {
  iccfgr = mfspr(SPR_ICCFGR);
  cpuinfo->icache.ways = 1 << (iccfgr & SPR_ICCFGR_NCW);
  cpuinfo->icache.sets = 1 << ((iccfgr & SPR_ICCFGR_NCS) >> 3);
  cpuinfo->icache.block_size = 16 << ((iccfgr & SPR_ICCFGR_CBS) >> 7);
  cpuinfo->icache.size =
      cpuinfo->icache.sets * cpuinfo->icache.ways * cpuinfo->icache.block_size;
  leaves += 1;
  printk(KERN_INFO
         "-- icache: %d bytes total, %d bytes/line, %d set(s), %d way(s)\n",
         cpuinfo->icache.size, cpuinfo->icache.block_size,
         cpuinfo->icache.sets, cpuinfo->icache.ways);
 } else
  printk(KERN_INFO "-- icache disabled\n");

 if (!leaves)
  return -ENOENT;

 levels = 1;

 this_cpu_ci->num_leaves = leaves;
 this_cpu_ci->num_levels = levels;

 return 0;
}

int populate_cache_leaves(unsigned int cpu)
{
 struct cpuinfo_or1k *cpuinfo = &cpuinfo_or1k[smp_processor_id()];
 struct cpu_cacheinfo *this_cpu_ci = get_cpu_cacheinfo(cpu);
 struct cacheinfo *this_leaf = this_cpu_ci->info_list;
 int level = 1;

 if (cpu_cache_is_present(SPR_UPR_DCP)) {
  ci_leaf_init(this_leaf, CACHE_TYPE_DATA, level, &cpuinfo->dcache, cpu);
  this_leaf->attributes = ((mfspr(SPR_DCCFGR) & SPR_DCCFGR_CWS) >> 8) ?
     CACHE_WRITE_BACK : CACHE_WRITE_THROUGH;
  this_leaf++;
 }

 if (cpu_cache_is_present(SPR_UPR_ICP))
  ci_leaf_init(this_leaf, CACHE_TYPE_INST, level, &cpuinfo->icache, cpu);

 this_cpu_ci->cpu_map_populated = true;

 return 0;
}