Orange Pi5 kernel

// SPDX-License-Identifier: GPL-2.0
// Copyright (C) 2005-2017 Andes Technology Corporation
 
#include <linux/compiler.h>
#include <linux/of_address.h>
#include <linux/of_fdt.h>
#include <linux/of_platform.h>
#include <asm/l2_cache.h>
 
void __iomem *atl2c_base;
static const struct of_device_id atl2c_ids[] __initconst = {
<------>{.compatible = "andestech,atl2c",},
<------>{}
};
 
static int __init atl2c_of_init(void)
{
<------>struct device_node *np;
<------>struct resource res;
<------>unsigned long tmp = 0;
<------>unsigned long l2set, l2way, l2clsz;
 
<------>if (!(__nds32__mfsr(NDS32_SR_MSC_CFG) & MSC_CFG_mskL2C))
<------><------>return -ENODEV;
 
<------>np = of_find_matching_node(NULL, atl2c_ids);
<------>if (!np)
<------><------>return -ENODEV;
 
<------>if (of_address_to_resource(np, 0, &res))
<------><------>return -ENODEV;
 
<------>atl2c_base = ioremap(res.start, resource_size(&res));
<------>if (!atl2c_base)
<------><------>return -ENOMEM;
 
<------>l2set =
<------>    64 << ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2SET) >>
<------><------>   L2_CA_CONF_offL2SET);
<------>l2way =
<------>    1 +
<------>    ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2WAY) >>
<------>     L2_CA_CONF_offL2WAY);
<------>l2clsz =
<------>    4 << ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2CLSZ) >>
<------><------>  L2_CA_CONF_offL2CLSZ);
<------>pr_info("L2:%luKB/%luS/%luW/%luB\n",
<------><------>l2set * l2way * l2clsz / 1024, l2set, l2way, l2clsz);
 
<------>tmp = L2C_R_REG(L2CC_PROT_OFF);
<------>tmp &= ~L2CC_PROT_mskMRWEN;
<------>L2C_W_REG(L2CC_PROT_OFF, tmp);
 
<------>tmp = L2C_R_REG(L2CC_SETUP_OFF);
<------>tmp &= ~L2CC_SETUP_mskPART;
<------>L2C_W_REG(L2CC_SETUP_OFF, tmp);
 
<------>tmp = L2C_R_REG(L2CC_CTRL_OFF);
<------>tmp |= L2CC_CTRL_mskEN;
<------>L2C_W_REG(L2CC_CTRL_OFF, tmp);
 
<------>return 0;
}
 
subsys_initcall(atl2c_of_init);