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) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) #include <linux/of_address.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <asm/mach/arch.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include "core.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #define SYS_FLAGSSET		0x030
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #define SYS_FLAGSCLR		0x034
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) void vexpress_flags_set(u32 data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	static void __iomem *base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 	if (!base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 		struct device_node *node = of_find_compatible_node(NULL, NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 				"arm,vexpress-sysreg");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 		base = of_iomap(node, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	if (WARN_ON(!base))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 	writel(~0, base + SYS_FLAGSCLR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	writel(data, base + SYS_FLAGSSET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) static const char * const v2m_dt_match[] __initconst = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	"arm,vexpress",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) DT_MACHINE_START(VEXPRESS_DT, "ARM-Versatile Express")
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	.dt_compat	= v2m_dt_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	.l2c_aux_val	= 0x00400000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	.l2c_aux_mask	= 0xfe0fffff,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	.smp		= smp_ops(vexpress_smp_dt_ops),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	.smp_init	= smp_init_ops(vexpress_smp_init_ops),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) MACHINE_END