Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) // Copyright (C) 2005-2017 Andes Technology Corporation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <linux/compiler.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include <linux/of_address.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <linux/of_fdt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <linux/of_platform.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <asm/l2_cache.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) void __iomem *atl2c_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) static const struct of_device_id atl2c_ids[] __initconst = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 	{.compatible = "andestech,atl2c",},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	{}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) static int __init atl2c_of_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 	struct device_node *np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	struct resource res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	unsigned long tmp = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	unsigned long l2set, l2way, l2clsz;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	if (!(__nds32__mfsr(NDS32_SR_MSC_CFG) & MSC_CFG_mskL2C))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	np = of_find_matching_node(NULL, atl2c_ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	if (!np)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	if (of_address_to_resource(np, 0, &res))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	atl2c_base = ioremap(res.start, resource_size(&res));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	if (!atl2c_base)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	l2set =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	    64 << ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2SET) >>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		   L2_CA_CONF_offL2SET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	l2way =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	    1 +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	    ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2WAY) >>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	     L2_CA_CONF_offL2WAY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	l2clsz =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	    4 << ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2CLSZ) >>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 		  L2_CA_CONF_offL2CLSZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	pr_info("L2:%luKB/%luS/%luW/%luB\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 		l2set * l2way * l2clsz / 1024, l2set, l2way, l2clsz);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	tmp = L2C_R_REG(L2CC_PROT_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	tmp &= ~L2CC_PROT_mskMRWEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	L2C_W_REG(L2CC_PROT_OFF, tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 	tmp = L2C_R_REG(L2CC_SETUP_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 	tmp &= ~L2CC_SETUP_mskPART;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	L2C_W_REG(L2CC_SETUP_OFF, tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	tmp = L2C_R_REG(L2CC_CTRL_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	tmp |= L2CC_CTRL_mskEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 	L2C_W_REG(L2CC_CTRL_OFF, tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) subsys_initcall(atl2c_of_init);