162306a36Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0-only */ 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * arch/arm/mach-spear13XX/headsmp.S 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Picked from realview 662306a36Sopenharmony_ci * Copyright (c) 2012 ST Microelectronics Limited 762306a36Sopenharmony_ci * Shiraz Hashim <shiraz.linux.kernel@gmail.com> 862306a36Sopenharmony_ci */ 962306a36Sopenharmony_ci 1062306a36Sopenharmony_ci#include <linux/linkage.h> 1162306a36Sopenharmony_ci#include <linux/init.h> 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci __INIT 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci/* 1662306a36Sopenharmony_ci * spear13xx specific entry point for secondary CPUs. This provides 1762306a36Sopenharmony_ci * a "holding pen" into which all secondary cores are held until we're 1862306a36Sopenharmony_ci * ready for them to initialise. 1962306a36Sopenharmony_ci */ 2062306a36Sopenharmony_ciENTRY(spear13xx_secondary_startup) 2162306a36Sopenharmony_ci mrc p15, 0, r0, c0, c0, 5 2262306a36Sopenharmony_ci and r0, r0, #15 2362306a36Sopenharmony_ci adr r4, 1f 2462306a36Sopenharmony_ci ldmia r4, {r5, r6} 2562306a36Sopenharmony_ci sub r4, r4, r5 2662306a36Sopenharmony_ci add r6, r6, r4 2762306a36Sopenharmony_cipen: ldr r7, [r6] 2862306a36Sopenharmony_ci cmp r7, r0 2962306a36Sopenharmony_ci bne pen 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci /* re-enable coherency */ 3262306a36Sopenharmony_ci mrc p15, 0, r0, c1, c0, 1 3362306a36Sopenharmony_ci orr r0, r0, #(1 << 6) | (1 << 0) 3462306a36Sopenharmony_ci mcr p15, 0, r0, c1, c0, 1 3562306a36Sopenharmony_ci /* 3662306a36Sopenharmony_ci * we've been released from the holding pen: secondary_stack 3762306a36Sopenharmony_ci * should now contain the SVC stack for this core 3862306a36Sopenharmony_ci */ 3962306a36Sopenharmony_ci b secondary_startup 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci .align 4262306a36Sopenharmony_ci1: .long . 4362306a36Sopenharmony_ci .long spear_pen_release 4462306a36Sopenharmony_ciENDPROC(spear13xx_secondary_startup) 45