blob: 633a3e08402757c6ba4c7cecce5c25a4d4a8b9e3 [file] [log] [blame]
Masahiro Yamada0ae5c5a2016-08-10 16:08:49 +09001/*
2 * Copyright (C) 2016 Socionext Inc.
3 * Author: Masahiro Yamada <yamada.masahiro@socionext.com>
4 *
5 * SPDX-License-Identifier: GPL-2.0+
6 */
7
8#include <common.h>
9#include <linux/bitops.h>
10#include <linux/io.h>
11#include <linux/kernel.h>
12#include <linux/psci.h>
13#include <linux/sizes.h>
14#include <asm/processor.h>
15#include <asm/psci.h>
16#include <asm/secure.h>
17
18#include "../debug.h"
19#include "../soc-info.h"
20#include "arm-mpcore.h"
21#include "cache-uniphier.h"
22
23#define UNIPHIER_SMPCTRL_ROM_RSV2 0x59801208
24
25void uniphier_smp_trampoline(void);
26void uniphier_smp_trampoline_end(void);
27u32 uniphier_smp_booted[CONFIG_ARMV7_PSCI_NR_CPUS];
28
29static int uniphier_get_nr_cpus(void)
30{
31 switch (uniphier_get_soc_type()) {
32 case SOC_UNIPHIER_SLD3:
33 case SOC_UNIPHIER_PRO4:
34 case SOC_UNIPHIER_PRO5:
35 return 2;
36 case SOC_UNIPHIER_PXS2:
37 case SOC_UNIPHIER_LD6B:
38 return 4;
39 default:
40 return 1;
41 }
42}
43
44static void uniphier_smp_kick_all_cpus(void)
45{
46 const u32 target_ways = BIT(0);
47 size_t trmp_size;
48 u32 trmp_src = (unsigned long)uniphier_smp_trampoline;
49 u32 trmp_src_end = (unsigned long)uniphier_smp_trampoline_end;
50 u32 trmp_dest, trmp_dest_end;
51 int nr_cpus, i;
52 int timeout = 1000;
53
54 nr_cpus = uniphier_get_nr_cpus();
55 if (nr_cpus == 1)
56 return;
57
58 for (i = 0; i < nr_cpus; i++) /* lock ways for all CPUs */
59 uniphier_cache_set_active_ways(i, 0);
60 uniphier_cache_inv_way(target_ways);
61 uniphier_cache_enable();
62
63 /* copy trampoline code */
64 uniphier_cache_prefetch_range(trmp_src, trmp_src_end, target_ways);
65
66 trmp_size = trmp_src_end - trmp_src;
67
68 trmp_dest = trmp_src & (SZ_64K - 1);
69 trmp_dest += SZ_1M - SZ_64K * 2;
70
71 trmp_dest_end = trmp_dest + trmp_size;
72
73 uniphier_cache_touch_range(trmp_dest, trmp_dest_end, target_ways);
74
75 writel(trmp_dest, UNIPHIER_SMPCTRL_ROM_RSV2);
76
77 asm("dsb ishst\n" /* Ensure the write to ROM_RSV2 is visible */
78 "sev"); /* Bring up all secondary CPUs from Boot ROM into U-Boot */
79
80 while (--timeout) {
81 int all_booted = 1;
82
83 for (i = 1; i < nr_cpus; i++)
84 if (!uniphier_smp_booted[i])
85 all_booted = 0;
86 if (all_booted)
87 break;
88 udelay(1);
89
90 /* barrier here because uniphier_smp_booted[] may be updated */
91 cpu_relax();
92 }
93
94 if (!timeout)
95 printf("warning: some of secondary CPUs may not boot\n");
96
97 uniphier_cache_disable();
98}
99
100void psci_board_init(void)
101{
102 unsigned long scu_base;
103 u32 scu_ctrl, tmp;
104
105 asm("mrc p15, 4, %0, c15, c0, 0" : "=r" (scu_base));
106
107 scu_ctrl = readl(scu_base + 0x30);
108 if (!(scu_ctrl & 1))
109 writel(scu_ctrl | 0x1, scu_base + 0x30);
110
111 scu_ctrl = readl(scu_base + SCU_CTRL);
112 scu_ctrl |= SCU_ENABLE | SCU_STANDBY_ENABLE;
113 writel(scu_ctrl, scu_base + SCU_CTRL);
114
115 tmp = readl(scu_base + SCU_SNSAC);
116 tmp |= 0xfff;
117 writel(tmp, scu_base + SCU_SNSAC);
118
119 uniphier_smp_kick_all_cpus();
120}
121
122void psci_arch_init(void)
123{
124 u32 actlr;
125
126 asm("mrc p15, 0, %0, c1, c0, 1" : "=r" (actlr));
127 actlr |= 0x41; /* set SMP and FW bits */
128 asm("mcr p15, 0, %0, c1, c0, 1" : : "r" (actlr));
129}
130
131u32 uniphier_psci_holding_pen_release __secure_data = 0xffffffff;
132
133int __secure psci_cpu_on(u32 function_id, u32 cpuid, u32 entry_point)
134{
135 u32 cpu = cpuid & 0xff;
136
137 debug_puts("[U-Boot PSCI] psci_cpu_on: cpuid=");
138 debug_puth(cpuid);
139 debug_puts(", entry_point=");
140 debug_puth(entry_point);
141 debug_puts("\n");
142
143 psci_save_target_pc(cpu, entry_point);
144
145 /* We assume D-cache is off, so do not call flush_dcache() here */
146 uniphier_psci_holding_pen_release = cpu;
147
148 /* Send an event to wake up the secondary CPU. */
149 asm("dsb ishst\n"
150 "sev");
151
152 return PSCI_RET_SUCCESS;
153}