xref: /OK3568_Linux_fs/kernel/arch/arm/mach-prima2/headsmp.S (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun/* SPDX-License-Identifier: GPL-2.0-or-later */
2*4882a593Smuzhiyun/*
3*4882a593Smuzhiyun * Entry of the second core for CSR Marco dual-core SMP SoCs
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (c) 2012 Cambridge Silicon Radio Limited, a CSR plc group company.
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun#include <linux/linkage.h>
9*4882a593Smuzhiyun#include <linux/init.h>
10*4882a593Smuzhiyun
11*4882a593Smuzhiyun/*
12*4882a593Smuzhiyun * SIRFSOC specific entry point for secondary CPUs.  This provides
13*4882a593Smuzhiyun * a "holding pen" into which all secondary cores are held until we're
14*4882a593Smuzhiyun * ready for them to initialise.
15*4882a593Smuzhiyun */
16*4882a593SmuzhiyunENTRY(sirfsoc_secondary_startup)
17*4882a593Smuzhiyun        mrc     p15, 0, r0, c0, c0, 5
18*4882a593Smuzhiyun        and     r0, r0, #15
19*4882a593Smuzhiyun        adr     r4, 1f
20*4882a593Smuzhiyun        ldmia   r4, {r5, r6}
21*4882a593Smuzhiyun        sub     r4, r4, r5
22*4882a593Smuzhiyun        add     r6, r6, r4
23*4882a593Smuzhiyunpen:    ldr     r7, [r6]
24*4882a593Smuzhiyun        cmp     r7, r0
25*4882a593Smuzhiyun        bne     pen
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun        /*
28*4882a593Smuzhiyun         * we've been released from the holding pen: secondary_stack
29*4882a593Smuzhiyun         * should now contain the SVC stack for this core
30*4882a593Smuzhiyun         */
31*4882a593Smuzhiyun        b       secondary_startup
32*4882a593SmuzhiyunENDPROC(sirfsoc_secondary_startup)
33*4882a593Smuzhiyun
34*4882a593Smuzhiyun        .align
35*4882a593Smuzhiyun1:      .long   .
36*4882a593Smuzhiyun        .long   prima2_pen_release
37