1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
| /*
| * Secondary CPU startup routine source file.
| *
| * Copyright (c) Allwinner. All rights reserved.
| *
| * Sugar <shuge@allwinnertech.com>
| *
| * Interface functions needed for the SMP. This file is based on arm
| * realview smp platform.
| * Copyright (c) 2003 ARM Limited.
| *
| * This program is free software,you can redistribute it and/or modify
| * it under the terms of the GNU General Public License version 2 as
| * published by the Free Software Foundation.
| */
|
| #include <linux/linkage.h>
| #include <linux/init.h>
|
| .text
| .align 4
|
| ENTRY(sunxi_secondary_startup)
| msr cpsr_fsxc, #0xd3 @ switch to SVC mode, disable IRQ
|
| mrc p15, 0, r0, c0, c0, 5 @ get core id
| and r0, r0, #0x3
|
| adr r1, _cpus_boot_entry
| ldmia r1, {r2, r3} @ address to jump to after
| sub lr, r1, r2 @ offset between Virt and Phy address
| add r3, r0, lsl #2
| ldr r2, [r3, lr] @ get address of secondary function
|
| mov r0, #0
| ldr r1, =0x104d @ Does secondary function need it?
|
| bx r2
| ENDPROC(sunxi_secondary_startup)
|
| .align
| _cpus_boot_entry:
| .long .
| .long cpus_boot_entry
|
| #ifdef CONFIG_ARM_SUNXI_CPUIDLE
| .text
| .align 4
|
| ENTRY(sunxi_cpux_entry_judge)
| msr cpsr_fsxc, #0xd3 @ switch to SVC mode, disable IRQ
|
| mrc p15, 0, r0, c0, c0, 5 @ get core id
| and r0, r0, #0x3
|
| adr r1, _cpux_entry_flag_array
| ldmia r1, {r2, r3} @ address to jump to after
| sub lr, r1, r2 @ offset between Virt and Phy address
| add r3, r0, lsl #2
| ldr r2, [r3, lr] @ get address of secondary function
| ldr r3, [r2]
| cmp r3, #1
| bne __cpu_resume
| b sunxi_secondary_startup
| __cpu_resume:
| mrc p15, 0, r1, c1, c0, 1 @ switch to SMP mode
| orr r1, r1, #0x40
| mcr p15, 0, r1, c1, c0, 1
| isb
| b cpu_resume
| ENDPROC(sunxi_cpux_entry_judge)
|
| .align
| _cpux_entry_flag_array:
| .long .
| .long cpux_flag_entry
| #endif
|
|
