1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * (C) Copyright 2008 Texas Insturments
4 *
5 * (C) Copyright 2002
6 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
7 * Marius Groeger <mgroeger@sysgo.de>
8 *
9 * (C) Copyright 2002
10 * Gary Jennejohn, DENX Software Engineering, <garyj@denx.de>
11 */
12
13#include <common.h>
14#include <command.h>
15#include <cpu_func.h>
16#include <irq_func.h>
17#include <asm/cache.h>
18#include <asm/system.h>
19#include <asm/secure.h>
20#include <linux/compiler.h>
21
22/*
23 * sdelay() - simple spin loop.
24 *
25 * Will delay execution by roughly (@loops * 2) cycles.
26 * This is necessary to be used before timers are accessible.
27 *
28 * A value of "0" will results in 2^64 loops.
29 */
30void sdelay(unsigned long loops)
31{
32	__asm__ volatile ("1:\n" "subs %0, %0, #1\n"
33			  "b.ne 1b" : "=r" (loops) : "0"(loops) : "cc");
34}
35
36void __weak board_cleanup_before_linux(void){}
37
38int cleanup_before_linux(void)
39{
40	/*
41	 * this function is called just before we call linux
42	 * it prepares the processor for linux
43	 *
44	 * disable interrupt and turn off caches etc ...
45	 */
46
47	board_cleanup_before_linux();
48
49	disable_interrupts();
50
51	if (IS_ENABLED(CONFIG_CMO_BY_VA_ONLY)) {
52		/*
53		 * Disable D-cache.
54		 */
55		dcache_disable();
56	} else {
57		/*
58		 * Turn off I-cache and invalidate it
59		 */
60		icache_disable();
61		invalidate_icache_all();
62
63		/*
64		 * turn off D-cache
65		 * dcache_disable() in turn flushes the d-cache and disables
66		 * MMU
67		 */
68		dcache_disable();
69		invalidate_dcache_all();
70	}
71
72	return 0;
73}
74
75#ifdef CONFIG_ARMV8_PSCI
76static void relocate_secure_section(void)
77{
78#ifdef CONFIG_ARMV8_SECURE_BASE
79	size_t sz = __secure_end - __secure_start;
80
81	memcpy((void *)CONFIG_ARMV8_SECURE_BASE, __secure_start, sz);
82	flush_dcache_range(CONFIG_ARMV8_SECURE_BASE,
83			   CONFIG_ARMV8_SECURE_BASE + sz + 1);
84	invalidate_icache_all();
85#endif
86}
87
88void armv8_setup_psci(void)
89{
90	if (current_el() != 3)
91		return;
92
93	relocate_secure_section();
94	secure_ram_addr(psci_setup_vectors)();
95	secure_ram_addr(psci_arch_init)();
96}
97#endif
98