104 lines · 3.2 KB · C
RawDownload
// 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;}