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  */
sdelay(unsigned long loops)30 void 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 
board_cleanup_before_linux(void)36 void __weak board_cleanup_before_linux(void){}
37 
cleanup_before_linux(void)38 int 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 	/*
52 	 * Turn off I-cache and invalidate it
53 	 */
54 	icache_disable();
55 	invalidate_icache_all();
56 
57 	/*
58 	 * turn off D-cache
59 	 * dcache_disable() in turn flushes the d-cache and disables MMU
60 	 */
61 	dcache_disable();
62 	invalidate_dcache_all();
63 
64 	return 0;
65 }
66 
67 #ifdef CONFIG_ARMV8_PSCI
relocate_secure_section(void)68 static void relocate_secure_section(void)
69 {
70 #ifdef CONFIG_ARMV8_SECURE_BASE
71 	size_t sz = __secure_end - __secure_start;
72 
73 	memcpy((void *)CONFIG_ARMV8_SECURE_BASE, __secure_start, sz);
74 	flush_dcache_range(CONFIG_ARMV8_SECURE_BASE,
75 			   CONFIG_ARMV8_SECURE_BASE + sz + 1);
76 	invalidate_icache_all();
77 #endif
78 }
79 
armv8_setup_psci(void)80 void armv8_setup_psci(void)
81 {
82 	relocate_secure_section();
83 	secure_ram_addr(psci_setup_vectors)();
84 	secure_ram_addr(psci_arch_init)();
85 }
86 #endif
87