16fba6e04STony Xie/* 26fba6e04STony Xie * Copyright (c) 2013-2016, ARM Limited and Contributors. All rights reserved. 36fba6e04STony Xie * 482cb2c1aSdp-arm * SPDX-License-Identifier: BSD-3-Clause 56fba6e04STony Xie */ 66fba6e04STony Xie 76fba6e04STony Xie#include <arch.h> 86fba6e04STony Xie#include <asm_macros.S> 96fba6e04STony Xie#include <bl_common.h> 106fba6e04STony Xie#include <cortex_a53.h> 116fba6e04STony Xie#include <cortex_a72.h> 126fba6e04STony Xie#include <plat_private.h> 136fba6e04STony Xie#include <platform_def.h> 149ec78bdfSTony Xie#include <plat_pmu_macros.S> 156fba6e04STony Xie 166fba6e04STony Xie .globl cpuson_entry_point 176fba6e04STony Xie .globl cpuson_flags 186fba6e04STony Xie .globl platform_cpu_warmboot 196fba6e04STony Xie .globl plat_secondary_cold_boot_setup 206fba6e04STony Xie .globl plat_report_exception 21*5eddd22eSDaniel Boulby .globl plat_is_my_cpu_primary 226fba6e04STony Xie .globl plat_my_core_pos 236fba6e04STony Xie .globl plat_reset_handler 24a33e763cSJulius Werner .globl plat_panic_handler 256fba6e04STony Xie 266fba6e04STony Xie /* 276fba6e04STony Xie * void plat_reset_handler(void); 286fba6e04STony Xie * 296fba6e04STony Xie * Determine the SOC type and call the appropriate reset 306fba6e04STony Xie * handler. 316fba6e04STony Xie * 326fba6e04STony Xie */ 336fba6e04STony Xiefunc plat_reset_handler 349ec78bdfSTony Xie mrs x0, midr_el1 359ec78bdfSTony Xie ubfx x0, x0, MIDR_PN_SHIFT, #12 369ec78bdfSTony Xie cmp w0, #((CORTEX_A72_MIDR >> MIDR_PN_SHIFT) & MIDR_PN_MASK) 379ec78bdfSTony Xie b.eq handler_a72 389ec78bdfSTony Xie b handler_end 399ec78bdfSTony Xiehandler_a72: 409ec78bdfSTony Xie /* 419ec78bdfSTony Xie * This handler does the following: 429ec78bdfSTony Xie * Set the L2 Data RAM latency for Cortex-A72. 439ec78bdfSTony Xie * Set the L2 Tag RAM latency to for Cortex-A72. 449ec78bdfSTony Xie */ 45fb7d32e5SVarun Wadekar mov x0, #((5 << CORTEX_A72_L2CTLR_DATA_RAM_LATENCY_SHIFT) | \ 469ec78bdfSTony Xie (0x1 << 5)) 47fb7d32e5SVarun Wadekar msr CORTEX_A72_L2CTLR_EL1, x0 489ec78bdfSTony Xie isb 499ec78bdfSTony Xiehandler_end: 509ec78bdfSTony Xie ret 516fba6e04STony Xieendfunc plat_reset_handler 526fba6e04STony Xie 536fba6e04STony Xiefunc plat_my_core_pos 546fba6e04STony Xie mrs x0, mpidr_el1 556fba6e04STony Xie and x1, x0, #MPIDR_CPU_MASK 566fba6e04STony Xie and x0, x0, #MPIDR_CLUSTER_MASK 579ec78bdfSTony Xie add x0, x1, x0, LSR #PLAT_RK_CLST_TO_CPUID_SHIFT 586fba6e04STony Xie ret 596fba6e04STony Xieendfunc plat_my_core_pos 606fba6e04STony Xie 616fba6e04STony Xie /* -------------------------------------------------------------------- 626fba6e04STony Xie * void plat_secondary_cold_boot_setup (void); 636fba6e04STony Xie * 646fba6e04STony Xie * This function performs any platform specific actions 656fba6e04STony Xie * needed for a secondary cpu after a cold reset e.g 666fba6e04STony Xie * mark the cpu's presence, mechanism to place it in a 676fba6e04STony Xie * holding pen etc. 686fba6e04STony Xie * -------------------------------------------------------------------- 696fba6e04STony Xie */ 706fba6e04STony Xiefunc plat_secondary_cold_boot_setup 716fba6e04STony Xie /* rk3368 does not do cold boot for secondary CPU */ 726fba6e04STony Xiecb_panic: 736fba6e04STony Xie b cb_panic 746fba6e04STony Xieendfunc plat_secondary_cold_boot_setup 756fba6e04STony Xie 76*5eddd22eSDaniel Boulbyfunc plat_is_my_cpu_primary 77*5eddd22eSDaniel Boulby mrs x0, mpidr_el1 786fba6e04STony Xie and x0, x0, #(MPIDR_CLUSTER_MASK | MPIDR_CPU_MASK) 796fba6e04STony Xie cmp x0, #PLAT_RK_PRIMARY_CPU 806fba6e04STony Xie cset x0, eq 816fba6e04STony Xie ret 82*5eddd22eSDaniel Boulbyendfunc plat_is_my_cpu_primary 836fba6e04STony Xie 846fba6e04STony Xie /* -------------------------------------------------------------------- 85a33e763cSJulius Werner * void plat_panic_handler(void) 86a33e763cSJulius Werner * Call system reset function on panic. Set up an emergency stack so we 87a33e763cSJulius Werner * can run C functions (it only needs to last for a few calls until we 88a33e763cSJulius Werner * reboot anyway). 89a33e763cSJulius Werner * -------------------------------------------------------------------- 90a33e763cSJulius Werner */ 91a33e763cSJulius Wernerfunc plat_panic_handler 92a33e763cSJulius Werner msr spsel, #0 93a33e763cSJulius Werner bl plat_set_my_stack 94a33e763cSJulius Werner b rockchip_soc_soft_reset 95a33e763cSJulius Wernerendfunc plat_panic_handler 96a33e763cSJulius Werner 97a33e763cSJulius Werner /* -------------------------------------------------------------------- 986fba6e04STony Xie * void platform_cpu_warmboot (void); 996fba6e04STony Xie * cpus online or resume enterpoint 1006fba6e04STony Xie * -------------------------------------------------------------------- 1016fba6e04STony Xie */ 10264726e6dSJulius Wernerfunc platform_cpu_warmboot _align=16 1036fba6e04STony Xie mrs x0, MPIDR_EL1 1049ec78bdfSTony Xie and x19, x0, #MPIDR_CPU_MASK 1059ec78bdfSTony Xie and x20, x0, #MPIDR_CLUSTER_MASK 1069ec78bdfSTony Xie mov x0, x20 1079ec78bdfSTony Xie func_rockchip_clst_warmboot 1086fba6e04STony Xie /* -------------------------------------------------------------------- 1096fba6e04STony Xie * big cluster id is 1 1106fba6e04STony Xie * big cores id is from 0-3, little cores id 4-7 1116fba6e04STony Xie * -------------------------------------------------------------------- 1126fba6e04STony Xie */ 1139ec78bdfSTony Xie add x21, x19, x20, lsr #PLAT_RK_CLST_TO_CPUID_SHIFT 1146fba6e04STony Xie /* -------------------------------------------------------------------- 1156fba6e04STony Xie * get per cpuup flag 1166fba6e04STony Xie * -------------------------------------------------------------------- 1176fba6e04STony Xie */ 1186fba6e04STony Xie adr x4, cpuson_flags 1199ec78bdfSTony Xie add x4, x4, x21, lsl #2 1206fba6e04STony Xie ldr w1, [x4] 1216fba6e04STony Xie /* -------------------------------------------------------------------- 1226fba6e04STony Xie * check cpuon reason 1236fba6e04STony Xie * -------------------------------------------------------------------- 1246fba6e04STony Xie */ 1259ec78bdfSTony Xie cmp w1, PMU_CPU_AUTO_PWRDN 1266fba6e04STony Xie b.eq boot_entry 1279ec78bdfSTony Xie cmp w1, PMU_CPU_HOTPLUG 1286fba6e04STony Xie b.eq boot_entry 1296fba6e04STony Xie /* -------------------------------------------------------------------- 1306fba6e04STony Xie * If the boot core cpuson_flags or cpuson_entry_point is not 1316fba6e04STony Xie * expection. force the core into wfe. 1326fba6e04STony Xie * -------------------------------------------------------------------- 1336fba6e04STony Xie */ 1346fba6e04STony Xiewfe_loop: 1356fba6e04STony Xie wfe 1366fba6e04STony Xie b wfe_loop 1376fba6e04STony Xieboot_entry: 1389ec78bdfSTony Xie str wzr, [x4] 139f47a25ddSCaesar Wang /* -------------------------------------------------------------------- 140f47a25ddSCaesar Wang * get per cpuup boot addr 141f47a25ddSCaesar Wang * -------------------------------------------------------------------- 142f47a25ddSCaesar Wang */ 143f47a25ddSCaesar Wang adr x5, cpuson_entry_point 1449ec78bdfSTony Xie ldr x2, [x5, x21, lsl #3] 1456fba6e04STony Xie br x2 1466fba6e04STony Xieendfunc platform_cpu_warmboot 1476fba6e04STony Xie 1486fba6e04STony Xie /* -------------------------------------------------------------------- 1496fba6e04STony Xie * Per-CPU Secure entry point - resume or power up 1506fba6e04STony Xie * -------------------------------------------------------------------- 1516fba6e04STony Xie */ 1526fba6e04STony Xie .section tzfw_coherent_mem, "a" 1536fba6e04STony Xie .align 3 1546fba6e04STony Xiecpuson_entry_point: 1556fba6e04STony Xie .rept PLATFORM_CORE_COUNT 1566fba6e04STony Xie .quad 0 1576fba6e04STony Xie .endr 1586fba6e04STony Xiecpuson_flags: 1596fba6e04STony Xie .rept PLATFORM_CORE_COUNT 160f47a25ddSCaesar Wang .word 0 1616fba6e04STony Xie .endr 1629ec78bdfSTony Xierockchip_clst_warmboot_data 163