1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Keystone2 based boards and SOC related code.
4 *
5 * Copyright 2013 Texas Instruments, Inc.
6 *	Cyril Chemparathy <cyril@ti.com>
7 *	Santosh Shilimkar <santosh.shillimkar@ti.com>
8 */
9
10#include <linux/io.h>
11#include <linux/dma-map-ops.h>
12#include <linux/init.h>
13#include <linux/pm_runtime.h>
14#include <linux/pm_clock.h>
15#include <linux/memblock.h>
16#include <linux/of.h>
17#include <linux/platform_device.h>
18
19#include <asm/setup.h>
20#include <asm/mach/map.h>
21#include <asm/mach/arch.h>
22#include <asm/mach/time.h>
23#include <asm/page.h>
24
25#define KEYSTONE_LOW_PHYS_START		0x80000000ULL
26#define KEYSTONE_LOW_PHYS_SIZE		0x80000000ULL /* 2G */
27#define KEYSTONE_LOW_PHYS_END		(KEYSTONE_LOW_PHYS_START + \
28					 KEYSTONE_LOW_PHYS_SIZE - 1)
29
30#define KEYSTONE_HIGH_PHYS_START	0x800000000ULL
31#define KEYSTONE_HIGH_PHYS_SIZE		0x400000000ULL	/* 16G */
32#define KEYSTONE_HIGH_PHYS_END		(KEYSTONE_HIGH_PHYS_START + \
33					 KEYSTONE_HIGH_PHYS_SIZE - 1)
34
35static struct dev_pm_domain keystone_pm_domain = {
36	.ops = {
37		USE_PM_CLK_RUNTIME_OPS
38		USE_PLATFORM_PM_SLEEP_OPS
39	},
40};
41
42static struct pm_clk_notifier_block platform_domain_notifier = {
43	.pm_domain = &keystone_pm_domain,
44	.con_ids = { NULL },
45};
46
47static const struct of_device_id of_keystone_table[] = {
48	{.compatible = "ti,k2hk"},
49	{.compatible = "ti,k2e"},
50	{.compatible = "ti,k2l"},
51	{ /* end of list */ },
52};
53
54static int __init keystone_pm_runtime_init(void)
55{
56	struct device_node *np;
57
58	np = of_find_matching_node(NULL, of_keystone_table);
59	if (!np)
60		return 0;
61
62	pm_clk_add_notifier(&platform_bus_type, &platform_domain_notifier);
63
64	return 0;
65}
66
67#ifdef CONFIG_ARM_LPAE
68static int keystone_platform_notifier(struct notifier_block *nb,
69				      unsigned long event, void *data)
70{
71	struct device *dev = data;
72
73	if (event != BUS_NOTIFY_ADD_DEVICE)
74		return NOTIFY_DONE;
75
76	if (!dev)
77		return NOTIFY_BAD;
78
79	if (!dev->of_node) {
80		int ret = dma_direct_set_offset(dev, KEYSTONE_HIGH_PHYS_START,
81						KEYSTONE_LOW_PHYS_START,
82						KEYSTONE_HIGH_PHYS_SIZE);
83		dev_err(dev, "set dma_offset%08llx%s\n",
84			KEYSTONE_HIGH_PHYS_START - KEYSTONE_LOW_PHYS_START,
85			ret ? " failed" : "");
86	}
87	return NOTIFY_OK;
88}
89
90static struct notifier_block platform_nb = {
91	.notifier_call = keystone_platform_notifier,
92};
93#endif /* CONFIG_ARM_LPAE */
94
95static void __init keystone_init(void)
96{
97#ifdef CONFIG_ARM_LPAE
98	if (PHYS_OFFSET >= KEYSTONE_HIGH_PHYS_START)
99		bus_register_notifier(&platform_bus_type, &platform_nb);
100#endif
101	keystone_pm_runtime_init();
102}
103
104static long long __init keystone_pv_fixup(void)
105{
106	long long offset;
107	u64 mem_start, mem_end;
108
109	mem_start = memblock_start_of_DRAM();
110	mem_end = memblock_end_of_DRAM();
111
112	/* nothing to do if we are running out of the <32-bit space */
113	if (mem_start >= KEYSTONE_LOW_PHYS_START &&
114	    mem_end   <= KEYSTONE_LOW_PHYS_END)
115		return 0;
116
117	if (mem_start < KEYSTONE_HIGH_PHYS_START ||
118	    mem_end   > KEYSTONE_HIGH_PHYS_END) {
119		pr_crit("Invalid address space for memory (%08llx-%08llx)\n",
120		        mem_start, mem_end);
121		return 0;
122	}
123
124	offset = KEYSTONE_HIGH_PHYS_START - KEYSTONE_LOW_PHYS_START;
125
126	/* Populate the arch idmap hook */
127	arch_phys_to_idmap_offset = -offset;
128
129	return offset;
130}
131
132static const char *const keystone_match[] __initconst = {
133	"ti,k2hk",
134	"ti,k2e",
135	"ti,k2l",
136	"ti,k2g",
137	"ti,keystone",
138	NULL,
139};
140
141DT_MACHINE_START(KEYSTONE, "Keystone")
142#if defined(CONFIG_ZONE_DMA) && defined(CONFIG_ARM_LPAE)
143	.dma_zone_size	= SZ_2G,
144#endif
145	.init_machine	= keystone_init,
146	.dt_compat	= keystone_match,
147	.pv_fixup	= keystone_pv_fixup,
148MACHINE_END
149