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