xref: /linux/arch/arm/mach-mvebu/headsmp.S (revision c4ee0af3fa0dc65f690fc908f02b8355f9576ea0)
1/*
2 * SMP support: Entry point for secondary CPUs
3 *
4 * Copyright (C) 2012 Marvell
5 *
6 * Yehuda Yitschak <yehuday@marvell.com>
7 * Gregory CLEMENT <gregory.clement@free-electrons.com>
8 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
9 *
10 * This file is licensed under the terms of the GNU General Public
11 * License version 2.  This program is licensed "as is" without any
12 * warranty of any kind, whether express or implied.
13 *
14 * This file implements the assembly entry point for secondary CPUs in
15 * an SMP kernel. The only thing we need to do is to add the CPU to
16 * the coherency fabric by writing to 2 registers. Currently the base
17 * register addresses are hard coded due to the early initialisation
18 * problems.
19 */
20
21#include <linux/linkage.h>
22#include <linux/init.h>
23
24#include <asm/assembler.h>
25
26/*
27 * Armada XP specific entry point for secondary CPUs.
28 * We add the CPU to the coherency fabric and then jump to secondary
29 * startup
30 */
31ENTRY(armada_xp_secondary_startup)
32 ARM_BE8(setend	be )			@ go BE8 if entered LE
33
34	/* Get coherency fabric base physical address */
35	adr	r0, 1f
36	ldr	r1, [r0]
37	ldr	r0, [r0, r1]
38
39	/* Read CPU id */
40	mrc     p15, 0, r1, c0, c0, 5
41	and     r1, r1, #0xF
42
43	/* Add CPU to coherency fabric */
44	bl	ll_set_cpu_coherent
45	b	secondary_startup
46
47ENDPROC(armada_xp_secondary_startup)
48
49	.align 2
501:
51	.long	coherency_phys_base - .
52