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