ea40c55dd2c080c18b8e2bf5e26063128c4e8acb
[platform/kernel/u-boot.git] / arch / arm / cpu / armv8 / cpu.c
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  */
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
36 void __weak board_cleanup_before_linux(void){}
37
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
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
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