2 * Coherency fabric (Aurora) support for Armada 370, 375, 38x and XP
5 * Copyright (C) 2012 Marvell
7 * Yehuda Yitschak <yehuday@marvell.com>
8 * Gregory Clement <gregory.clement@free-electrons.com>
9 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
11 * This file is licensed under the terms of the GNU General Public
12 * License version 2. This program is licensed "as is" without any
13 * warranty of any kind, whether express or implied.
15 * The Armada 370, 375, 38x and XP SOCs have a coherency fabric which is
16 * responsible for ensuring hardware coherency between all CPUs and between
17 * CPUs and I/O masters. This file initializes the coherency fabric and
18 * supplies basic routines for configuring and controlling hardware coherency
21 #define pr_fmt(fmt) "mvebu-coherency: " fmt
23 #include <linux/kernel.h>
24 #include <linux/init.h>
25 #include <linux/of_address.h>
27 #include <linux/smp.h>
28 #include <linux/dma-mapping.h>
29 #include <linux/platform_device.h>
30 #include <linux/slab.h>
31 #include <linux/mbus.h>
32 #include <linux/pci.h>
33 #include <asm/smp_plat.h>
34 #include <asm/cacheflush.h>
35 #include <asm/mach/map.h>
36 #include <asm/dma-mapping.h>
37 #include "coherency.h"
38 #include "mvebu-soc-id.h"
40 unsigned long coherency_phys_base
;
41 void __iomem
*coherency_base
;
42 static void __iomem
*coherency_cpu_base
;
43 static void __iomem
*cpu_config_base
;
45 /* Coherency fabric registers */
46 #define IO_SYNC_BARRIER_CTL_OFFSET 0x0
49 COHERENCY_FABRIC_TYPE_NONE
,
50 COHERENCY_FABRIC_TYPE_ARMADA_370_XP
,
51 COHERENCY_FABRIC_TYPE_ARMADA_375
,
52 COHERENCY_FABRIC_TYPE_ARMADA_380
,
55 static const struct of_device_id of_coherency_table
[] = {
56 {.compatible
= "marvell,coherency-fabric",
57 .data
= (void *) COHERENCY_FABRIC_TYPE_ARMADA_370_XP
},
58 {.compatible
= "marvell,armada-375-coherency-fabric",
59 .data
= (void *) COHERENCY_FABRIC_TYPE_ARMADA_375
},
60 {.compatible
= "marvell,armada-380-coherency-fabric",
61 .data
= (void *) COHERENCY_FABRIC_TYPE_ARMADA_380
},
62 { /* end of list */ },
65 /* Functions defined in coherency_ll.S */
66 int ll_enable_coherency(void);
67 void ll_add_cpu_to_smp_group(void);
69 #define CPU_CONFIG_SHARED_L2 BIT(16)
72 * Disable the "Shared L2 Present" bit in CPU Configuration register
75 * The "Shared L2 Present" bit affects the "level of coherence" value
76 * in the clidr CP15 register. Cache operation functions such as
77 * "flush all" and "invalidate all" operate on all the cache levels
78 * that included in the defined level of coherence. When HW I/O
79 * coherency is used, this bit causes unnecessary flushes of the L2
82 static void armada_xp_clear_shared_l2(void)
89 reg
= readl(cpu_config_base
);
90 reg
&= ~CPU_CONFIG_SHARED_L2
;
91 writel(reg
, cpu_config_base
);
94 static int mvebu_hwcc_notifier(struct notifier_block
*nb
,
95 unsigned long event
, void *__dev
)
97 struct device
*dev
= __dev
;
99 if (event
!= BUS_NOTIFY_ADD_DEVICE
)
101 set_dma_ops(dev
, &arm_coherent_dma_ops
);
106 static struct notifier_block mvebu_hwcc_nb
= {
107 .notifier_call
= mvebu_hwcc_notifier
,
110 static struct notifier_block mvebu_hwcc_pci_nb __maybe_unused
= {
111 .notifier_call
= mvebu_hwcc_notifier
,
114 static int armada_xp_clear_l2_starting(unsigned int cpu
)
116 armada_xp_clear_shared_l2();
120 static void __init
armada_370_coherency_init(struct device_node
*np
)
123 struct device_node
*cpu_config_np
;
125 of_address_to_resource(np
, 0, &res
);
126 coherency_phys_base
= res
.start
;
128 * Ensure secondary CPUs will see the updated value,
129 * which they read before they join the coherency
130 * fabric, and therefore before they are coherent with
131 * the boot CPU cache.
133 sync_cache_w(&coherency_phys_base
);
134 coherency_base
= of_iomap(np
, 0);
135 coherency_cpu_base
= of_iomap(np
, 1);
137 cpu_config_np
= of_find_compatible_node(NULL
, NULL
,
138 "marvell,armada-xp-cpu-config");
142 cpu_config_base
= of_iomap(cpu_config_np
, 0);
143 if (!cpu_config_base
) {
144 of_node_put(cpu_config_np
);
148 of_node_put(cpu_config_np
);
150 cpuhp_setup_state_nocalls(CPUHP_AP_ARM_MVEBU_COHERENCY
,
151 "AP_ARM_MVEBU_COHERENCY",
152 armada_xp_clear_l2_starting
, NULL
);
158 * This ioremap hook is used on Armada 375/38x to ensure that PCIe
159 * memory areas are mapped as MT_UNCACHED instead of MT_DEVICE. This
160 * is needed as a workaround for a deadlock issue between the PCIe
161 * interface and the cache controller.
163 static void __iomem
*
164 armada_pcie_wa_ioremap_caller(phys_addr_t phys_addr
, size_t size
,
165 unsigned int mtype
, void *caller
)
167 struct resource pcie_mem
;
169 mvebu_mbus_get_pcie_mem_aperture(&pcie_mem
);
171 if (pcie_mem
.start
<= phys_addr
&& (phys_addr
+ size
) <= pcie_mem
.end
)
174 return __arm_ioremap_caller(phys_addr
, size
, mtype
, caller
);
177 static void __init
armada_375_380_coherency_init(struct device_node
*np
)
179 struct device_node
*cache_dn
;
181 coherency_cpu_base
= of_iomap(np
, 0);
182 arch_ioremap_caller
= armada_pcie_wa_ioremap_caller
;
185 * We should switch the PL310 to I/O coherency mode only if
186 * I/O coherency is actually enabled.
188 if (!coherency_available())
192 * Add the PL310 property "arm,io-coherent". This makes sure the
193 * outer sync operation is not used, which allows to
194 * workaround the system erratum that causes deadlocks when
195 * doing PCIe in an SMP situation on Armada 375 and Armada
198 for_each_compatible_node(cache_dn
, NULL
, "arm,pl310-cache") {
201 p
= kzalloc(sizeof(*p
), GFP_KERNEL
);
202 p
->name
= kstrdup("arm,io-coherent", GFP_KERNEL
);
203 of_add_property(cache_dn
, p
);
207 static int coherency_type(void)
209 struct device_node
*np
;
210 const struct of_device_id
*match
;
214 * The coherency fabric is needed:
215 * - For coherency between processors on Armada XP, so only
216 * when SMP is enabled.
217 * - For coherency between the processor and I/O devices, but
218 * this coherency requires many pre-requisites (write
219 * allocate cache policy, shareable pages, SMP bit set) that
220 * are only meant in SMP situations.
222 * Note that this means that on Armada 370, there is currently
223 * no way to use hardware I/O coherency, because even when
224 * CONFIG_SMP is enabled, is_smp() returns false due to the
225 * Armada 370 being a single-core processor. To lift this
226 * limitation, we would have to find a way to make the cache
227 * policy set to write-allocate (on all Armada SoCs), and to
228 * set the shareable attribute in page tables (on all Armada
229 * SoCs except the Armada 370). Unfortunately, such decisions
230 * are taken very early in the kernel boot process, at a point
231 * where we don't know yet on which SoC we are running.
235 return COHERENCY_FABRIC_TYPE_NONE
;
237 np
= of_find_matching_node_and_match(NULL
, of_coherency_table
, &match
);
239 return COHERENCY_FABRIC_TYPE_NONE
;
241 type
= (int) match
->data
;
248 int set_cpu_coherent(void)
250 int type
= coherency_type();
252 if (type
== COHERENCY_FABRIC_TYPE_ARMADA_370_XP
) {
253 if (!coherency_base
) {
254 pr_warn("Can't make current CPU cache coherent.\n");
255 pr_warn("Coherency fabric is not initialized\n");
259 armada_xp_clear_shared_l2();
260 ll_add_cpu_to_smp_group();
261 return ll_enable_coherency();
267 int coherency_available(void)
269 return coherency_type() != COHERENCY_FABRIC_TYPE_NONE
;
272 int __init
coherency_init(void)
274 int type
= coherency_type();
275 struct device_node
*np
;
277 np
= of_find_matching_node(NULL
, of_coherency_table
);
279 if (type
== COHERENCY_FABRIC_TYPE_ARMADA_370_XP
)
280 armada_370_coherency_init(np
);
281 else if (type
== COHERENCY_FABRIC_TYPE_ARMADA_375
||
282 type
== COHERENCY_FABRIC_TYPE_ARMADA_380
)
283 armada_375_380_coherency_init(np
);
290 static int __init
coherency_late_init(void)
292 if (coherency_available())
293 bus_register_notifier(&platform_bus_type
,
298 postcore_initcall(coherency_late_init
);
300 #if IS_ENABLED(CONFIG_PCI)
301 static int __init
coherency_pci_init(void)
303 if (coherency_available())
304 bus_register_notifier(&pci_bus_type
,
309 arch_initcall(coherency_pci_init
);