xref: /OK3568_Linux_fs/kernel/arch/arm/mach-keystone/keystone.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Keystone2 based boards and SOC related code.
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright 2013 Texas Instruments, Inc.
6*4882a593Smuzhiyun  *	Cyril Chemparathy <cyril@ti.com>
7*4882a593Smuzhiyun  *	Santosh Shilimkar <santosh.shillimkar@ti.com>
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun #include <linux/io.h>
10*4882a593Smuzhiyun #include <linux/of.h>
11*4882a593Smuzhiyun #include <linux/dma-mapping.h>
12*4882a593Smuzhiyun #include <linux/init.h>
13*4882a593Smuzhiyun #include <linux/of_platform.h>
14*4882a593Smuzhiyun #include <linux/of_address.h>
15*4882a593Smuzhiyun #include <linux/memblock.h>
16*4882a593Smuzhiyun 
17*4882a593Smuzhiyun #include <asm/setup.h>
18*4882a593Smuzhiyun #include <asm/mach/map.h>
19*4882a593Smuzhiyun #include <asm/mach/arch.h>
20*4882a593Smuzhiyun #include <asm/mach/time.h>
21*4882a593Smuzhiyun #include <asm/smp_plat.h>
22*4882a593Smuzhiyun #include <asm/memory.h>
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun #include "memory.h"
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #include "keystone.h"
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun #ifdef CONFIG_ARM_LPAE
keystone_platform_notifier(struct notifier_block * nb,unsigned long event,void * data)29*4882a593Smuzhiyun static int keystone_platform_notifier(struct notifier_block *nb,
30*4882a593Smuzhiyun 				      unsigned long event, void *data)
31*4882a593Smuzhiyun {
32*4882a593Smuzhiyun 	struct device *dev = data;
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun 	if (event != BUS_NOTIFY_ADD_DEVICE)
35*4882a593Smuzhiyun 		return NOTIFY_DONE;
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun 	if (!dev)
38*4882a593Smuzhiyun 		return NOTIFY_BAD;
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun 	if (!dev->of_node) {
41*4882a593Smuzhiyun 		int ret = dma_direct_set_offset(dev, KEYSTONE_HIGH_PHYS_START,
42*4882a593Smuzhiyun 						KEYSTONE_LOW_PHYS_START,
43*4882a593Smuzhiyun 						KEYSTONE_HIGH_PHYS_SIZE);
44*4882a593Smuzhiyun 		dev_err(dev, "set dma_offset%08llx%s\n",
45*4882a593Smuzhiyun 			KEYSTONE_HIGH_PHYS_START - KEYSTONE_LOW_PHYS_START,
46*4882a593Smuzhiyun 			ret ? " failed" : "");
47*4882a593Smuzhiyun 	}
48*4882a593Smuzhiyun 	return NOTIFY_OK;
49*4882a593Smuzhiyun }
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun static struct notifier_block platform_nb = {
52*4882a593Smuzhiyun 	.notifier_call = keystone_platform_notifier,
53*4882a593Smuzhiyun };
54*4882a593Smuzhiyun #endif /* CONFIG_ARM_LPAE */
55*4882a593Smuzhiyun 
keystone_init(void)56*4882a593Smuzhiyun static void __init keystone_init(void)
57*4882a593Smuzhiyun {
58*4882a593Smuzhiyun #ifdef CONFIG_ARM_LPAE
59*4882a593Smuzhiyun 	if (PHYS_OFFSET >= KEYSTONE_HIGH_PHYS_START)
60*4882a593Smuzhiyun 		bus_register_notifier(&platform_bus_type, &platform_nb);
61*4882a593Smuzhiyun #endif
62*4882a593Smuzhiyun 	keystone_pm_runtime_init();
63*4882a593Smuzhiyun }
64*4882a593Smuzhiyun 
keystone_pv_fixup(void)65*4882a593Smuzhiyun static long long __init keystone_pv_fixup(void)
66*4882a593Smuzhiyun {
67*4882a593Smuzhiyun 	long long offset;
68*4882a593Smuzhiyun 	u64 mem_start, mem_end;
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 	mem_start = memblock_start_of_DRAM();
71*4882a593Smuzhiyun 	mem_end = memblock_end_of_DRAM();
72*4882a593Smuzhiyun 
73*4882a593Smuzhiyun 	/* nothing to do if we are running out of the <32-bit space */
74*4882a593Smuzhiyun 	if (mem_start >= KEYSTONE_LOW_PHYS_START &&
75*4882a593Smuzhiyun 	    mem_end   <= KEYSTONE_LOW_PHYS_END)
76*4882a593Smuzhiyun 		return 0;
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	if (mem_start < KEYSTONE_HIGH_PHYS_START ||
79*4882a593Smuzhiyun 	    mem_end   > KEYSTONE_HIGH_PHYS_END) {
80*4882a593Smuzhiyun 		pr_crit("Invalid address space for memory (%08llx-%08llx)\n",
81*4882a593Smuzhiyun 		        mem_start, mem_end);
82*4882a593Smuzhiyun 		return 0;
83*4882a593Smuzhiyun 	}
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun 	offset = KEYSTONE_HIGH_PHYS_START - KEYSTONE_LOW_PHYS_START;
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun 	/* Populate the arch idmap hook */
88*4882a593Smuzhiyun 	arch_phys_to_idmap_offset = -offset;
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun 	return offset;
91*4882a593Smuzhiyun }
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun static const char *const keystone_match[] __initconst = {
94*4882a593Smuzhiyun 	"ti,k2hk",
95*4882a593Smuzhiyun 	"ti,k2e",
96*4882a593Smuzhiyun 	"ti,k2l",
97*4882a593Smuzhiyun 	"ti,k2g",
98*4882a593Smuzhiyun 	"ti,keystone",
99*4882a593Smuzhiyun 	NULL,
100*4882a593Smuzhiyun };
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun DT_MACHINE_START(KEYSTONE, "Keystone")
103*4882a593Smuzhiyun #if defined(CONFIG_ZONE_DMA) && defined(CONFIG_ARM_LPAE)
104*4882a593Smuzhiyun 	.dma_zone_size	= SZ_2G,
105*4882a593Smuzhiyun #endif
106*4882a593Smuzhiyun 	.smp		= smp_ops(keystone_smp_ops),
107*4882a593Smuzhiyun 	.init_machine	= keystone_init,
108*4882a593Smuzhiyun 	.dt_compat	= keystone_match,
109*4882a593Smuzhiyun 	.pv_fixup	= keystone_pv_fixup,
110*4882a593Smuzhiyun MACHINE_END
111