1 // SPDX-License-Identifier: GPL-2.0 1
2 /*
3 * Device Tree support for MStar/Sigmastar Arm
4 *
5 * Copyright (c) 2020 thingy.jp
6 * Author: Daniel Palmer <daniel@thingy.jp>
7 */
8
9 #include <linux/init.h>
10 #include <asm/mach/arch.h>
11 #include <asm/mach/map.h>
12 #include <linux/of.h>
13 #include <linux/of_address.h>
14 #include <linux/io.h>
15
16 /*
17 * In the u-boot code the area these registers
18 * called "L3 bridge" and there are register d
19 * for something in the same area called "AXI"
20 *
21 * It's not exactly known what this is but the
22 * for both u-boot and linux share calls to "f
23 * This seems to be to force pending CPU write
24 * the state is right before DMA capable devic
25 * descriptors and data the CPU has prepared.
26 * ethernet doesn't work reliably for example.
27 */
28
29 #define MSTARV7_L3BRIDGE_FLUSH 0x14
30 #define MSTARV7_L3BRIDGE_STATUS 0x40
31 #define MSTARV7_L3BRIDGE_FLUSH_TRIGGER BIT(0)
32 #define MSTARV7_L3BRIDGE_STATUS_DONE BIT(12
33
34 #ifdef CONFIG_SMP
35 #define MSTARV7_CPU1_BOOT_ADDR_HIGH 0x4c
36 #define MSTARV7_CPU1_BOOT_ADDR_LOW 0x50
37 #define MSTARV7_CPU1_UNLOCK 0x58
38 #define MSTARV7_CPU1_UNLOCK_MAGIC 0xbabe
39 #endif
40
41 static void __iomem *l3bridge;
42
43 static const char * const mstarv7_board_dt_com
44 "mstar,infinity",
45 "mstar,infinity2m",
46 "mstar,infinity3",
47 "mstar,mercury5",
48 NULL,
49 };
50
51 /*
52 * This may need locking to deal with situatio
53 * happens while we are in here and mb() gets
54 *
55 * The vendor code did have a spin lock but it
56 * removing it hasn't caused any side effects
57 *
58 * [writel|readl]_relaxed have to be used here
59 * we'd end up right back in here.
60 */
61 static void mstarv7_mb(void)
62 {
63 /* toggle the flush miu pipe fire bit
64 writel_relaxed(0, l3bridge + MSTARV7_L
65 writel_relaxed(MSTARV7_L3BRIDGE_FLUSH_
66 + MSTARV7_L3BRIDGE_FLU
67 while (!(readl_relaxed(l3bridge + MSTA
68 & MSTARV7_L3BRIDGE_STA
69 /* wait for flush to complete
70 }
71 }
72
73 #ifdef CONFIG_SMP
74 static int mstarv7_boot_secondary(unsigned int
75 {
76 struct device_node *np;
77 u32 bootaddr = (u32) __pa_symbol(secon
78 void __iomem *smpctrl;
79
80 /*
81 * right now we don't know how to boot
82 * cpu 1.
83 */
84 if (cpu != 1)
85 return -EINVAL;
86
87 np = of_find_compatible_node(NULL, NUL
88 smpctrl = of_iomap(np, 0);
89
90 if (!smpctrl)
91 return -ENODEV;
92
93 /* set the boot address for the second
94 writew(bootaddr & 0xffff, smpctrl + MS
95 writew((bootaddr >> 16) & 0xffff, smpc
96
97 /* unlock the second cpu */
98 writew(MSTARV7_CPU1_UNLOCK_MAGIC, smpc
99
100 /* and away we go...*/
101 arch_send_wakeup_ipi_mask(cpumask_of(c
102
103 iounmap(smpctrl);
104
105 return 0;
106 }
107
108 static const struct smp_operations __initdata
109 .smp_boot_secondary = mstarv7_boot_sec
110 };
111 #endif
112
113 static void __init mstarv7_init(void)
114 {
115 struct device_node *np;
116
117 np = of_find_compatible_node(NULL, NUL
118 l3bridge = of_iomap(np, 0);
119 if (l3bridge)
120 soc_mb = mstarv7_mb;
121 else
122 pr_warn("Failed to install mem
123 }
124
125 DT_MACHINE_START(MSTARV7_DT, "MStar/Sigmastar
126 .dt_compat = mstarv7_board_dt_com
127 .init_machine = mstarv7_init,
128 .smp = smp_ops(mstarv7_smp_
129 MACHINE_END
130
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.